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Foreword 

This  report  contains  details  of  the  first  year  of  a  three  year  research  study  on  nonlinear  mod¬ 
eling  and  control  of  flexible  space  structures  with  application  to  rapid  slewing  and  precision 
pointing  of  space-based  directed  energy  weapons.  The  project  is  funded  by  SDIO/IST  and 
managed  by  AFOSR/SDIO  (AFSC).  Results  reported  herein  are  for  the  period  1  Sept.  1987 
-  31  Aug.  1988. 

The  project  is  managed  by  Ltn.  Col.  James  M.  Crowley/AFOSR/NM  and  Dr.  Anthony 
Amos/AFOSR/NA.  We  wish  to  thank  both  of  these  individuals  for  their  insight  and  direction 
on  this  project. 
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1  Research  Objectives  and  Project  Summary 

The  primary  research  objectives  of  the  first  year  effort  in  nonlinear  modeling  and  control  of 
flexible  space  structures  has  been  in  two  areas.  First,  we  have  considered  nonlinear  modeling 
of  a  generic  class  of  multibody  systems  with  elastic  interactions  with  primary  focus  on  a 
generic  model  for  structural  interactions  effecting  laser  system  Une-of-sight  (LOS)  pointing 
for  a  Space-Based  Laser  (SBL)  weapon.  Second,  we  have  developed  practical  extensions  and 
applications  of  the  theory  of  nonlinear  control  system  synthesis  based  on  the  ideal  of  effective 
global  linearization  by  feedback  transformation.  Our  approach  to  nonlinear  control  has  been 
based  on  the  ideal  of  Partial  Feedback •  Linearization  (PFL)  with  respect  to  a  principal  system 
output  representing  optical  system  pointing. 

During  the  performance  period  1  September,  1987  -  31  August,  1988  we  performed  an 
extensive  literature  survey  of  available  dynamic  models  and  control  system  issues  relating 
to  primary  system  performance  for  a  space-based  Directed  Energy  Weapon  (DEW).  Critical 
requirements  for  precision  line-of-sight  (LOS)  pointing  and  tracking  together  with  require¬ 
ments  for  rapid  slewing  of  spacecraft  primary  body  together  with  possible  articulated  weapon 
system  aperture  have  been  isolated  as  important,  control  problems  relating  to  system  perfor¬ 
mance  (see  Figure  1.1).  Additionally,  beam  quality  and  jitter  is  related  to  probably  of  kill 
and  is  largely  effected  by  controlling  alignment  of  elements  within  the  beam  expander.  Our 
efforts  have  focused  on  developing  a  generic  collection  of  models  for  SBL  type  systems  in¬ 
cluding  provisions  for:  1)  a  primary  body  with  attitude  control  components  including  either 
reaction  wheels  or  control  moment  gyros  and  reaction  jets,  2)  a  secondary  body  representing 
the  beam  expander  base  structure,  and  3)  a  continuum  beam  representing  structural  support 
for  the  secondary  mirror  of  the  beam  expander.  The  modeling  approach  is  readily  adaptable 
to  the  generic  problem  of  rapid  slewing  and  precision  pointing  of  a  multibody  system  subject 
to  elastic  deformation.  We  have  developed  a  series  of  generic  models  of  increasing  complexity 
to  study  the  critical  nonlinear  dynamics  effecting  LOS  pointing  and  optical  system  alignment 
for  a  benchmark  SBL  system.  A  computer  simulation  was  developed  and  preliminary  system 
tradeoffs  are  detailed  in  this  report. 

In  the  area  of  nonlinear  control  design  for  rapid  slewing  and  precision  pointing  we  have 
demonstrated  the  potential  for  decoupling  control  synthesis  wherein  the  flexible  dynamics  of 
the  weapon  system  secondary  mirror  support  structure  can  be  decoupled  from  the  effective 
weapon  system  LOS  by  the  introduction  of  nonlinear  feedback.  The  generic  class  of  such 
transformations  obtained  for  the  SBL  slewing  models  we  have  investigated  have  a  special 
structure  which  permits  the  decoupling/linearizing  transformation  to  be  implemented  sim¬ 
ply  by  using  multiple  actuators.  One  wav  in  which  this  may  be  used  to  advantage  is  in 
the  integration  of  continuous  mode  (e.g.  reaction  wheels,  C'MG’s,  etc.)  and  discontinuous 
(on/off)  actuation  (e.g.  jets).  In  particular,  continuous  actuation  can  be  used  to  effect  the 
exact  linearizing  transformation  and  decoupling  of  the  structural  flexure  from  the  LOS  while 
reaction  jets  can  be  used  for  large  angle  slewing  control.  This  has  significant  advantages  for 
rapid  slewing. 

We  have  also  identified  the  potential  for  the  application  of  low  cost  accelerometers  as  the 
primary  sensors  for  implementing  the  feedback  linearizing  control  laws.  The  primary  benefits 
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Figure  1.1:  Generic  Space-Based  Laser  System  with  Multiple  Control  Systems 

which  may  accrue  from  the  use  of  a  relatively  large  number  of  accelerometers  mounted  on 
certain  critical  structural  components  are  1)  a  reduction  in  the  sensitivity  of  the  decoupling 
control  to  detailed  knowledge  of  the  elastic  stiffness  and  damping  properties  of  the  structure 
and  2)  simplified  computational  requirements  for  on-line  implementation  of  the  nonlinear 
decoupling  control. 

A  critical  observation  in  our  studies  of  control  architectures  for  SBL  systems  is  the  inte¬ 
gration  of  a  variety  of  actuators  for  spacecraft  attitude  control  (e.g.  thruster  jets,  momentum 
wheels,  CMG’s,  etc.),  multibody  articulation,  optical  system  components  (e.g.  steering  and 
deformable  focusing  mirrors),  and  structural  vibration  control  (e.g.  proof  mass  devices, 
embedded  piezoelectrics,  etc.)  to  achieve  principal  system  performance  objectives.  In  this 
report  we  give  several  examples  including  simulation  results  demonstrating  options  for  the 
integration  of  various  actuators  to  achieve  optical  system  LOS  decoupling  from  structural 
deformation  using  optical  components. 

A  critical  feature  of  the  control  integration  problem  for  rapid  slewing  is  the  relative  levels 
of  control  authority  and  control  bandwidth  achievable  from  the  above  spectrum  of  actuator 
technologies.  The  system  requirements  study  [Gea88]  presents  a  comprehensive  assessment  of 
engineering  design  requirements  for  control  of  SBL  type  systems  and  motivates  requirements 
for  1)  torque  shaping  for  deformation  control,  and  2)  actuator  sizing  for  slewing  control.  In 
a  series  of  papers  and  a  technical  report  which  we  have  included  as  an  appendix,  Prof. 
Dwyer  describes  a  design  approach  for  deformation  shaping  of  torques  required  for  feedback 
linearization.  In  the  second  year  effort  we  will  study  the  application  of  these  methods  for 
implementing  rapid  slewing  with  available  torque  actuators. 
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2  Status  of  the  Research  Effort:  Initial  Conclusions 

The  performance  requirements  of  space-based  directed  energy  weapons  as  well  as  other  large 
aperture  optical  systems  will  place  unprecedented  demands  on  the  control  precision  for  such 
critical  mission  objectives  as  optical  systems  pointing  and  tracking  and  retargeting  maneu¬ 
vers.  System  requirements  for  rapid  retargeting  typically  involve  large  angle  slewing  maneu¬ 
vers  involving  the  spacecraft  bus  together  with  large  optical  system  structures  which  may  or 
may  not  be  articulated  as  part  of  slewing.  Such  maneuvers  will  involve  nonlinear  kinematics 
and  gyroscopic  coupling,  which  is  further  complicated  by  coupling  with  the  deformation  of 
the  optical  train  support  structure. 

Our  objective  is  to  demonstrate  the  feasibility  and  benefits  of  advanced  nonlinear  control 
design  methods  for  rapid  slewing  and  precision  pointing  of  spaced-based  platforms  subject 
to  structural  flexure  effecting  primary  system  LOS  and  focusing.  Our  primary  focus  comes 
from  requirements  for  rapid  retargeting  of  space  based  laser  systems.  To  be  meaningful,  such 
an  analysis  must  be  based  on  models  of  realistic  scale.  At.  the  same  time,  the  precise  config¬ 
uration  of  potential  systems  is  not  yet  known.  Since  various  system  configurations  including 
space  and  laboratory  experimental  systems  are  anticipated  the  focus  of  our  FY88  effort  was 
on  modeling  a  generic  class  of  multibody  systems  with  elastic  structural  interactions  which 
can  be  used  to  study  qualitative  nonlinear  behavior  of  such  systems. 

In  this  report  we  describe  a  framework  for  the  systematic  modeling  of  multibody  flexible 
structures.  It  should  be  noted  that  multibody  dynamics,  including  modeling,  is  an  area 
of  intense  current  research.  The  approach  described  here  is  focused  to  address  the  issues 
relevant,  to  control  system  design.  Among  these  are  three  general  considerations: 

•  Different  views  of  the  same  system  are  appropriate  at  different,  stages  of  design. 

•  Models  must  provide  insights  into  the  system  qualitative  behavior  and  must  also  pro¬ 
vide  useful  vehicles  for  computation. 

•  The  models  must,  interface  easily  to  standard  structural  design  and  analysis  tools  for 
ease  of  data  transfer. 

The  primary  goal  of  the  modeling  effort  is  to  provide  a  basis  for  design  and  analysis  of 
control  systems  for  rapid  slewing,  precision  pointing,  and  structural  vibration  control.  In  the 
first  year  effort  we  have  focused  on  nonlinear  methods  for  the  first  two  control  system  design 
requirements.  Our  methods  are  based  on  a  blend  of  state-of-the-art.  methods  for  nonlinear 
control  system  design  based  on  modern  methods  of  differential  geometry  and  Exact  Feedback 
Linearization  ( EEL )  and  well  proven  methods  of  linear  system  control  system  synthesis  and 
design  based  on  frequency  response  p,  thods.  The  balance  of  considerations  for  state-space 
or  internal  dynamical  modeling  and  input-output  or  transfer  function  models  has  proven 
increasingly  important  in  providing  a  quantifiable  basis  for  robust  control  system  design  for 
linear  systems.  The  methods  of  nonlinear  EFL,  however,  are  primarily  based  on  state  space 
models.  In  this  report  we  indicate  how  the  input-output  characterization  of  an  important 
class  of  nonlinear  systems  can  play  an  important,  role  in  control  system  design  for  rapid 
slewing. 
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The  primary  goal  of  this  project  for  the  next  year  is  the  design  of  a  series  of  laboratory 
experiments  to  demonstrate  the  viability  of  the  nonlinear  control  methods  described  in  this 
report.  One  central  issue  in  practical  applications  and  laboratory  experiments  is  the  extent 
to  which  modeling  assumptions  can  effect  results.  This  report  describes  the  basis  for  the 
nonlinear  control  methods  of  EFL  and  shows  that  in  principal  they  are  based  on  “exact, 
cancelation”  of  certain  critical  nonlinear  terms.  Thus  we  have  included  a  survey  of  methods 
for  robust  nonlinear  control  system  design  for  a  variety  of  methods  related  to  EFL  in  Sec¬ 
tion  7.  In  the  Research  Progress  and  Forecast  Report  [BBK88]  we  discussed  the  relationship 
between  nonlinear  control  based  on  EFL  and  control  systems  using  the  idea  of  a  “sliding 
mode”  (sometimes  called  Variable  Structure  Control).  These  methods  implement  a  high  gain 
control  which  can  be  inherently  robust  under  certain  conditions  by  utilizing  discontinuous 
(switching)  controllers.  We  believe  the  integration  of  discontinuous  and  continuous  mode 
control  actuation  is  an  important — indeed  essential — feature  of  rapid  slewing  control. 

3  Evolution  Equations  of  Lagrangian  Dynamics 

The  formalism  of  Lagrangian  dynamics  begins  with  the  identification  of  the  configuration 
space,  i.e.  the  generalized  coordinates,  associated  with  the  dynamical  system  of  interest. 
Once  the  configuration  manifold,  M,  is  specified  we  have  the  natural  definition  of  velocity 
at  a  point  q  £  M  as  an  vector,  q ,  in  the  tangent  space  to  M  at  q,  often  denoted  TqM.  We 
then  define  the  state  space  as  the  union  of  all  points  q  £  M  along  with  their  tangent  spaces, 
the  so-called  tangent  bundle  (c.f.  [AM78,  Arn78])  TqM.  The  evolution  of  the  system  in 
the  state  space  is  characterized  using  Hamilton’s  principle  of  least  action  by  the  definition 
of  a  Lagrangian  L{q,q)  :  M  X  TqM  — > •  3?.  Hamilton’s  principle  says  that  the  motion  of  a 
dynamical  system  between  times  t\  and  is  a  “natural”  motion  if  and  only  if 

sfhLdt=  0,  (3.1) 

or-— accounting  for  the  presence  of  external  generalized  forces,  Q — in  its  generalized  form; 

[t\5L  +  QT6q)dt  =  0.  (3.2) 

Jti 

For  distributed  parameter  systems  (DPS),  special  care  is  required  to  properly  characterize 
the  configuration  space  for  modeling  the  system  motions.  The  principal  reasons  for  this 
fact  follow  from  the  application  of  the  models  obtained;  viz.,  the  study  of  time  evolutions 
subject  to  control  forces.  First,  control  systems  will  inevitably  involve  the  implementation 
of  feedback  and  we  are  therefore  immediately  concerned  with  stability.  An  appropriate 
notion  of  stability  is  central  to  the  design  of  feedback  control  systems.  For  Lagrangian 
systems  the  natural  definition  of  stability  is  implicit  in  the  structure  of  the  state  space 
which  for  DPS  is  a  function  space  and  care  must  be  exercised  that  the  construction  (and 
assumptions)  of  the  state  space  are  consistent  with  the  engineering  control  problem.  Second, 
it  is  often  necessary  to  define  finite  dimensional  approximations  to  DPS  for  a  variety  of 
reasons  including  computer  simulation.  Again,  our  primary  concern  is  in  approximating  the 
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time  evolution  under  the  influence  of  control.  As  we  will  make  clear  in  the  following  section, 
the  formulation  of  such  models  in  a  consistent  way  is  inherently  bound  to  the  definition  of 
the  configuration  space.  In  this  section  we  confine  our  discussion  to  the  configuration  space 
for  continuous  systems  with  one  spatial  dimension. 

The  generalized  coordinates  are  chosen  so  that  all  “nonworking”  or  geometric  constraints 
on  the  motion  are  eliminated.  This  is  the  key  to  the  utility  of  the  Lagrange  formalism 
for  constructing  the  equations  of  motion.  In  the  case  of  DPS  any  “geometric”  boundary 
conditions  (which  we  will  denote  Q)  are  therefore  included  as  part  of  the  definition  of  the 
configuration  space.  All  other  boundary  conditions  necessary  to  complete  the  Euler-Lagrange 
equations  result  from  the  application  of  Hamilton's  Principle,  (3.1)  or  (3.2).  These  are  the 
“natural”  boundary  conditions  (denoted  A f). 

An  essential  part  of  the  definition  of  the  configuration  space  in  the  infinite  dimensional 
case  is  the  specification  of  the  norm.  Although  all  norms  are  equivalent  in  finite  dimensions, 
this  is  certainly  not  the  case  in  infinite  dimensions.  We  briefly  summarize  the  main  issues. 
Consider  functions  v(z )  defined  on  the  domain  r  £  [0,1]  and  let  Drv(z)  denote  the  rth 
derivative  with  respect  to  r.  We  denote  by  Hp  the  completion  of  the  set  of  the  set  of 
functions  with  p  continuous  derivatives  and  which  satisfy 

Ml  =  [l{\Dpv(z)\2  +  ...  +  M -)|2}dr  <  oo  (3.3) 

JO 

These  are  the  Sobolev  spaces  [LioTl].  Equivalently,  Hp  consists  of  those  functions  whose  first 
p  derivatives  belong  to  the  Hilbert  space  of  square  integrable  functions.  Note  that  x  £  H' 
implies  x  £  H'~x  for  i  =  1, 2, . . .. 

Let  Hg  denote  the  completion  of  the  set  of  functions  satisfying  (3.3)  as  well  as  a  pre¬ 
scribed  set.  of  boundary  conditions  designated  Q .  It  is  not  necessarily  true  that  all  of  the 
functions  in  this  new  space  satisfy  the  boundary  conditions.  The  reason  for  this  is  that  an 
arbitrary  sequence  of  functions,  all  satisfying  the  given  boundary  conditions,  may  converge 
to  a  function  which  does  not  satisfy  the  boundary  conditions.  However,  the  following  propo¬ 
sition  is  true.  Suppose  the  boundary  conditions  Q  involve  derivatives  of  order  s  and  none 
higher.  Then  all  of  the  functions  in  Hg  satisfy  the  boundary  conditions  provided  p  >  s. 
Thus,  a  consistent  definition  of  the  configuration  space  is  obtained  if  the  specified  norm  is 
compatible  with  the  geometric  boundary  conditions. 

Hamilton’s  principle  may  be  used  to  derive  the  Euler-Lagrange  equations  and  the  natural 
boundary  conditions.  The  Euler-Lagrange  equations  are  to  be  solved  along  with  boundary 
conditions  B  =  Q  U  Af.  In  general,  the  Lagrangian  will  involve  derivatives  with  respect  to  r 
of  order  p  and  the  Euler-Lagrarge  equations  will  involve  derivatives  of  order  2 p.  In  finding 
solutions  q(t)  we  seek  “weak”  (sometimes  called  generalized  or  distributional1)  solutions  in 
Hg  which  satisfy  Hamilton’s  principle  or  “strong”  (pointwise,  genuine  or  classical)  solutions 
in  H ^  which  satisfy  the  Euler-Lagrange  equations.  The  results  are  equivalent  (in  Hg)  when 
both  problems  have  solutions.  The  Euler-Lagrange  equations  may  be  given  the  interpretation 
of  an  evolution  equation  as  we  sill  describe  below. 

'There  are  several  approaches  to  developing  the  notion  weak  and  strong  solutions  and  many  good  reasons 
for  doing  so.  Thus,  the  proliferation  of  terminology  carries  with  it  sometimes  subtle  distinctions  (c.f.  (SF73, 
RM57,  Sta79]). 
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Figure  3.1:  Simple  Cantilevered  Beam 

Finite  Dimensional  Approximation  and  Computer  Simulation  Finite  dimensional 
approximations  to  the  system  dynamics  may  be  obtained  by  seeking  an  approximate  solu¬ 
tion  to  the  Euler-Lagrange  equations  or  to  Hamilton's  principle  directly.  The  latter  has  the 
advantage  that  solutions  are  to  be  sought  in  a  larger  space  of  admissible  functions  which  pro¬ 
vides  a  wider  choice  of  approximating  functions.  Perhaps  unexpectedly,  this  turns  out  to  be 
of  fundamental  significance  in  developing  numerical  solutions  to  the  required  evolution  dy¬ 
namics  and  for  computer  simulation.  Furthermore,  important  links  to  the  system  physics  are 
retained  through  this  modeling  process.  These  observations  appear  consistent  with  many 
standard  engineering  methods  which  introduce  approximations  to  continuous,  distributed 
system  dynamics  by  discretization  of  the  variational  problem  underlying  the  Lagrangian 
dyanmics  [Mei67].  Indeed,  this  is  the  basis  for  the  Finite  Element  Method  (FEM)  for  evolu¬ 
tion  dynamics  described  in  [SF73].  The  simulation  models  developed  in  this  study  are  based 
on  finite  dimensional  approximation  using  collocation  by  splines  [Aga84,  Sta79,  Pre75].  Fur¬ 
ther  details  of  the  method  will  be  given  in  a  later  section  with  examples. 

Next  we  consider  some  simple  continuous  systems  arising  in  structural  mechanics  which 
will  illustrate  the  evolution  modeling  setup  described  above. 

3.1  Example:  Simple  Cantilevered  Beam 

Consider  the  cantilevered  beam  undergoing  small  transverse  motions  confined  to  the  plane. 
The  beam  is  excited  by  a  concentrated  force,  /(<),  and  moment,  m(t),  applied  at.  the  point 

r=  flG(Q,l). 

Timoshenko  Model.  Each  cross  section  undergoes  a  displacement  and  a  rotation 

These  are  the  generalized  coordinates.  The  geometric  boundary  conditions  are 

Q  :  t?(0,  1)=0  and  0(0, 1)  =  0. 

Thus,  the  appropriate  configuration  space  is  Hg.  The  Lagrangian  is 
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8W  =  [  {f(t)8(z  —  a)Sri  +  m(t)8(z  —  a)8<f>}dz, 

Jo 

where  p  is  the  mass  density,  A ,  the  cross  section  area,  I,  the  moment  of  inertia,  E,  the 
modulus  of  elasticity,  and  kG ,  the  effective  shear  modulus.  Upon  application  of  Hamilton’s 
principle,  we  obtain  the  partial  differential  equations 

'Am  = 


and  the  natural  boundary  conditions 


M:  HCa(^-*)=0  and  El  (M  =  0. 


Thus,  we  have  the  evolution  equation 


pA  0  /  17  \  d_  kGA^z  —kGA  (  Tj 

0  pi  \  d>  J  dz  kGA  EI^kGA  \ 


where  we  interpret  if),  </>(•,  t)}T  as  an  element  in  Hg. 


8(z~a) 


Bernoulli-Euler  Model.  Suppose  that  we  consider  the  same  situation  with  the  additional 
Bernoulli-Euler  assumptions  [BK89j.  These  are 

1.  rotational  inertia  is  negligible,  pi  — >  0, 

2.  shear  deformation  is  negligible,  tj.  —  <f>  0. 

The  deformed  beam  configuration  is  completely  specified  by  rj(z,  t).  The  geometric  boundary 
conditions  are 

Q  ■  77(0, 1)  =  0  and  —  =  0. 

Notice  that  the  appropriate  configuration  space  is  Hg.  The  simplified  Lagrangian  is 


and  the  virtual  work  expression  also  simplifies  to 


=  j /(<)£(■=  -  a)8ii  +  m(t)6(z  -  a)<5  dz 

=  fQ  {f(t)6(z  -a)  +  m(t)8-\z  -  a)}  8V  dz. 
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The  evolution  equation  is 


d2 

^  +  9? 


El 25 


=  f{t)H -  -  a)  +  m{t)S  l(z  -  a). 


which  is  to  be  interpreted  on  Hg  with 


M  : 


El 


d3r?((,t) 

dz3 


—  0  and  El 


d2y((J) 
dz 2 


=  0. 


4  Generic  Models  for  Multibody  Flexible  Spacecraft 


In  this  section  we  describe  the  basis  for  the  formal  development  of  a  class  of  evolution  mod¬ 
els  for  multibody  systems  with  elastic  interactions.  We  follow  the  approach  suggested  by 
Baillieul  and  Levi  [BL87].  As  will  be  seen,  the  formulation  captures  the  essential  evolution 
dynamical  structure  of  the  system  without  requiring  detailed  knowledge  of  its  internal  con¬ 
figuration.  As  such  this  framework  provides  a  consistent,  modeling  approach  for  developing 
a  hierarchy  of  models  with  increasing  internal  complexity  and  fine  structure.  The  main  idea 
is  to  isolate  a  “primary  body”  and  to  attach  a  reference  frame  to  it  at  a  convenient  loca¬ 
tion  for  measuring  attitude  and  displacement  dynamics.  The  motion  of  all  other  spacecraft 
components  will  then  be  measured  relative  to  this  frame. 

Throughout  this  report  we  will  use  the  notational  conventions  given  in  Table  4.1.  Con¬ 
sider  a  reference  frame  fixed  in  the  primary  body,  with  origin  located  by  the  position  vector 
R  <E  !h'3  and  angular  orientation  denoted  by  L  €  50(3),  both  relative  to  a  fixed  inertial  frame 
(see  Figure  4.1).  L  can  be  parameterized  by  the  Euler  angles2  0,  9,  <p  representing  sequential 
rotations  about  the  axes  3,2,1,  respectively: 


L  = 


cos  9  cos  V’  cos  9  sin  9  —  sin  $ 

sin  d>  sin  #  cos  V’ —  cos  d>  sin  V’  sin  <£sin  9  sin  4'  -f  cos  4>cos  4'  sin  d>  cos  9 
cos  d>  sin  9  cos  V’  +  sin  d>  sin  i/’  cos  <j>  sin  9  sin  i/’  —  sin  d>  cos  i/’  cos  <b  cos  9 


A  fundamental  kinematic  relationship  is 

L(t)  =  -Q(t)L(t) 


(4.1) 


(4.2) 


where 


Q  = 


0 

<A>3 

—  U>2 


—  U>3 

0 

U>1 


U>2 

0 


(4.3) 


and  ijJ  —  (a,’i , u.’2, u.’3 )T  is  the  primary  body  (inertial)  angular  velocity  as  measured  in  the 
body  coordinates. 


•VVV  use  the  so-called  NASA  standard  or  321  convention  [Gol82j. 
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y,0 


Figure  4.1:  Standard  Coordinate  Frame  for  Modeling 


Notation 

Explanation 

Xi,  i  —  1,2,... 

element  of  a  vector  x 

T 

X 

transpose  of  vector  x 

■  dx 

X  ~  dt 

time  differentiation 

xz(t,z)  =  £(z,t) 

partial  differentiation 

(-.*> 

natural  (Hilbert  space)  inner  product 

II  •  II 

natural  (Hilbert  space)  norm 

Sx 

differential  variation 

X  x  y 

vector  cross  product  of  a:  and  y 

Table  4.1:  Standard  Notation  for  Lagrangian  Mechanics 
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Define  £  £  5?3  as  £  =  (0,0, 0)r.  Then  an  equivalent  relation3  is 

10  —  sin  9 

£  =  r(£)w,  r-’(0  =  0  cos  V’  cos0sin0  •  (4.4) 

0  —  sin  0  cos  9  cos  0 

The  body  frame  position  and  orientation  can  be  characterized  as  a  point  in  the  special 
Euclidian  group.  S' ( 3 ,  T? ) ,  each  element  of  which  can  be  represented  by  a  matrix 

The  positions  of  all  other  elements  of  the  system  are  measured  relative  to  the  primary  body 
frame.  We  identify  each  particle  (or  element),  P,  by  its  “undeformed”  position,  z,  in  the 
primary  body  frame.  Let  u(z,t)  denote  the  deformed  position  of  P.  Furthermore,  we  fix 
a  coordinate  system  in  each  particle  with  origin  at  u{z,t)  and  aligned — in  the  undeformed 
state — with  the  body  axis  coordinates.  Let.  C(z,t)  €  50(3)  denote  the  orientation  of  P  in  the 
deformed  state  as  measured  in  the  primary  body  coordinates.  Note  that  in  the  undeformed 
state 

'10  0' 

^unde  formed  =  0  10  (4.6) 

0  0  1. 

and  for  small  relative  motions4 


t  small  — 


1  0  -9 

-0  1  0 
9  -0  1 


The  inertial  coordinates  U{z,t)  of  a  particle  P  can  be  obtained  from  the  body  coordinates 
u(z,t)  via  the  relation 

U{z,t)  =  LTu(z,t)  +  R.  (4.8) 


Note  also  that. 


X(t)  = 


LT(t)Q(t)  R(t) 


Also,  a  direct  computation  yields 


-r -U  =  LT(t)[Qu  +  u]  +  R(t) 

at 


(4.10) 


3Equation  (4.4)  is  essential  to  the  analytic  framework  for  multibody  modeling.  Alternate  parametmations 
of  50(3) — such  as  the  C'ayley-Rodrigues  parameters  (Dwy84) — can  be  used  to  advantage  and  the  general 
form  remains  intact. 

4This  is  a  standard  assumption  in  modeling  small  elastic  deformation.  A  considerably  different  class 
of  models  is  obtained  using  exact  (i.e.  “geometric")  deformation  model  as  in  [Pos88],  Since  our  primary 
concern  in  this  study  is  to  develop  a  class  of  models  applicable  for  flexure  modeling  affecting  precision  optical 
systems  we  retain  the  small  deformation  assumption  throughout. 
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The  kinetic  energy  of  the  system  can  be  written  in  terms  of  the  generalized  coordinates 
q  =  (£,  R,  v)  in  the  form 

T(q,q)  =  ';Js\\U\\2dm  =iJs\\LT{nu  +  ut}  +  R\\2dm 

=  ^  ls\\[Qu  +  vt}\\2 +  2(Qu  +  ut,LR)  +  \\R\\2dm  (4.11) 

where  S  denotes  that  the  integral  is  to  be  taken  over  the  entire  system. 


d 

dT 

dT 

1 

dV 

dt 

dt  ~ 

dt 

-r 

dt 

d 

dT 

dT 

+ 

dV 

It 

dR  ~ 

dR 

dR 

d 

ST 

ST 

+ 

SV 

dt 

Su 

Su 

Su 

(4.12) 


4.1  Lagrange’s  Equations 

In  addition  to  the  kinetic  energy,  T(q.q),  we  assume  that  a  potential  energy  function  V(q) 
is  also  available.  Then  Lagrange's  equations  take  the  form 

=  Q(, 

=  Qr, 

=  <2u. 

where  the  generalized  forces  are  defined  in  terms  of  the  virtual  work  expression ; 

6W  =  QT(dt  +  QTRdR  +  Ql6u.  (4.13) 

Now,  we  define  the  system  angular  momentum  with  respect  to  the  origin  of  the  body  frame 

W.  u  x  [(w  x  u  +  u t )  +  LR]dm  =  a  4-  J  u  x  LR  dm.  (4. 14) 

With  some  calculation5  these  equations  reduce  to 

System  Angular  Momentum 

dv 


rT(£ )[a  +  uj  x  a]  +  J  u(z,t)  x  LR  dm  =  Q( 


dC 


L 


System  Linear  Momentum 
d  d\,w 

s[dtLT^Ut  +  w  x  v)  +  dm  =  Qr  - 


utt  +  wx(wxu)+«xii  +  2ux  ut  +  LR  =  Qu  — 


SY_ 

Su 


(4.15) 

(4.16) 

(4.17) 


Equivalently  we  obtain 


rr(()[/u,'  +  wx  Iu>]  +  me  x  LR+YT(t)D  |iix[u)Xu  +  ut}dm  +  J  ux  L  Rdm  =  Q(  —  (4.18) 


'Appendix  A  contains  some  identities  useful  for  these  calculations. 
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r  ..  dV 

m  R  +  mLT[u)  x  (u>  x  c)  +  u>  x  c]  +  /  LT[D2u  +  LR}dm  =  Qa  - 

y  5  <7/1 


D2u  +  LR  =  pu  - 


where  the  operator  Z?  is  defined  by 


(4.19) 


(4.20) 


£(•):=  -(.)  +  u,x(-) 

Note  that.,  in  applications,  the  integrals  in  (4.15)-(4.17)  or  (4. 18 )— (4. 17)  would  not  be 
evaluated  directly.  Instead,  they  are  to  be  replaced  by  momentum  expressions  in  terms  of 
an  appropriate  choice  of  generalized  coordinates. 


4.2  Generic  Models  for  Slewing  and  Pointing  of  Precision  Optical  Structures 

In  this  section  we  develop  several  benchmark  generic  models  for  rapid  slewing  and  precision 
pointing  of  flexible  space  structures  which  are  motivated  by  problems  relating  to  control 
of  precision  optical  structures  subject  to  elastic  interactions.  Such  problems  arise  in  re- 
quirements  for  rapid  retargeting  coupled  with  precision  pointing  for  space-based  laser  (SBL) 
systems.  The  models  reflect,  generic  qualitative  dynamical  properties  of  such  systems.  In  a 
subsequent  section  we  develop  a  simulation  model  with  physical  parameters  obtained  from 
the  benchmark  SBL  structural  model  developed  in  [Lea87j. 

The  models  developed  in  this  section  focus  on  primary  sources  of  structural  interaction 
with  principal  body  slewing  maneuvers  affecting  system  LOS  pointing.  Modeling  assump¬ 
tions  used  to  characterize  generic  responses  are  based  on  the  initial  system  level  tradeoffs 
described  in  the  R  Sc  D  Associates  report  [Lea87].  This  study  indicates  that  the  principal 
source  of  structural  flexure  affecting  laser  LOS  is  within  the  beam  expanded  optical  train — 
the  principal  structural  component  being  the  metering  truss  supporting  the  relative  position 
and  orientation  of  the  primary  and  secondary  mirrors.  Our  initial  or  first-level  model  assumes 
the  beam  expander  primary  mirror  and  support  is  rigidly  attached  to  the  spacecraft  body 
and  only  the  metering  truss  is  subject  to  flexure.  In  the  second  model  we  include  provisions 
for  articulation  of  the  SBL  beam  expander  with  respect  to  the  SBL  system  spacecraft  body 
using  a  gimbaled  joint. 

4.2.1  Example:  Rigid  Body  With  1-Dimensional  Appendage 

We  consider  a  single  rigid  body  attached  to  a  flexible  appendage  as  illustrated  in  Figure  4.2. 
The  system  kinetic  energy  can  be  expressed  as 


T  =  \  [  ||fii/||2  +  2{Slu,LR)  +  ||/?||2</m 

J  rb 

+  1  [  ||ftu  T  t/f||2  +  2(f hi  +  LR)  +  || f?||2(/m 
Jfb 

=  \u>l I hu,’h  -  mbcTUbLR  +  |u7f,||/?||2 

+  I  J‘{\\nbri  +  Tjt || 2  +  2(0^  +  Vt,  LR)  +  ||/?||2}M  dz 


(4.21) 
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+  2  /  {f Ub  +  (t\r I{ub  +  £t\}p  dz 

where  c  €  5f3  is  the  location  of  the  rigid  body  center  of  mass  in  the  body  frame,  mb  is  the 
mass  of  the  rigid  body.  It,  is  the  inertia  tensor  of  the  rigid  body  in  the  body  frame,  and 
p  is  the  mass  density  of  the  beam,  rj(z,t)  is  the  position  vector  of  points  on  the  deformed 
centerline  of  the  beam  in  the  primary  body  coordinate  frame  and  £(',<)  =  (V1, 0,  4>)T(  z,  t)  is 
the  beam  angular  deformation.  We  have  assumed  small  deformation  of  the  beam  so  that  the 
angular  velocity  of  the  beam  section  at  z  is 

u)(z,  t)  =  U>b  +  £t(~i  t) 

up  to  first  order  in  the  angular  deformation. 

The  potential  energy  of  the  system  consists  only  of  the  potential  energy  associated  with 
deformation  of  the  beam.  Under  Timoshenko  beam  assumptions  [CKEFKP68]  the  potential 
energy  function  is 

V'K,,)  =  \j‘{GJ(i’z)2  +  EI2(ez)2  +  EIz(4>..)2 

4  KiGA{T]h;  -  6)2  +  K2CrA(r]2iZ  -  cf>)2  +  pEA(V3,;  -  l)2}  dz  (4.22) 
=  k  f‘{(£Kt*)  +  (riS-Pt)TS(TI'-i)}dz 

where  the  stiffness  matrices  are  defined  as 

I<  =  diag (GJ,EI2,EIZ),  S  =  dmg(slGA,K2GA,pEA), 


and 


r  o  i  o  l 


p  = 


1  0  0 
0  0  0 


The  system  angular  momentum  vector  is 


a  —  lbu>b  -f  J  [At]  x  (wj,  x  j]  4-  rf)  4-  Iu>]p  dz 

so  that  equations  (4. 1-5)— (4. 17)  reduce  to 
rr(£)(/(,u>{,  4-  u>b  x  Ibu;b) 

+  J  [rr(£),477  x  (ritt  -f  <jjb  x  (wi  x  Tj)  +  (Jjb  x  7/  4  2u>b  x  rj ) 

4  Arj  x  LR  4-  I(ui  4  ujb  x  <jj)\p  dz  +  me  x  LR  =  Q^,  (4.23 ) 

r( 

mR  4-  mLT{ ui  x  (u>  x  c)  4-  w  x  c)  4-  /  pA(LT D2r]  4-  R)dz  =  Q{ ?,  (4.24) 

Jo 

pA{ptt  +  wi,  x  (wi,  x  ^)  4  H  x  r/  +  2o>b  x  ^  +  LR)  =  -  S{rjzz  -  P(~),  (4.25) 

pi [6<  +  H  +  wj  x  (wj  4-  &)]  =  Q(  —  A  £z:  +  PT S(pz  —  P().  (4-26) 
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System  Dissipation  A  simple  model  of  generalized  dissipation  in  the  appendage  can  be 
obtained  by  introducing  a  Rayleigh  dissipation  function.  We  formulate  such  a  function  based 
on  the  assumption  that  dissipation  forces  are  proportional  to  beam  deformation  rates,  i.e. 
generalized  coordinate  velocities  (i)t  and  £f)  and  strain  rates  —  9t,  ( rj2)tz  —  4>t,(tz)- 

R-iVt’tt)  =  \  [  {’ll ^iVt  +  +  (ihz)T~3Vtz  +  (£t;)T~4[£tz)}dz  (4.27) 

J  o 

where  =  diag (Ci,  (,‘,2,  £iz).  From  we  obtain  the  generalized  dissipative  forces 

SR 

7  —  +  ^aiVtzz  —  P£tz  ),  (4.28) 

8R 

—  =  6  +  E3(^-P6)  +  H46,z.  (4.29) 

4.3  Example:  Articulated  Bodies  With  Flexible  Appendage 

We  now  consider  a  modification  of  the  previous  Example  which  includes  a  second  body 
attached  to  the  primary  body  with  a  three  axis  gimbal  as  illustrated  in  Figure  2.  In  addition, 
the  second  body  carries  with  it  a  reaction  wheel  package.  The  kinetic  energy  function  is 

T  =  lu.’J/pa-p  -  mpCpQpLR  +  \mp\\R\\2 

V  V'  -  - - — 

primary  body 

+  2 -  m,c]U,L,{LR  +  QpCgm}  +  \m,\\LR  +  Qpcgm  ||2 

v - - - ^ - - 

second  body  (wheels  locked) 

+  '2^3  I3W3  +  urj  1 3UI3 

s .  "  ■V*  1  1  ' 

reaction  wheels 

+  2  /  {II^p^  +  ^t||2  +  2(QP?7  4-  rjt ,  LR)  +  ||i?||2}p.4  dz 
Jo 

+  k  [  {K  +  it?  I(*p  +  6)}  pdz  (4.30) 

JO 

Note  that  cp  and  c,  are  the  locations  of  the  center  of  gravity  of  the  primary  body  and 
second  body  (including  wheels)  in  their  respective  body  coordinate  frames.  The  vector  cgm 
denotes  the  location  of  the  three  axis  gimbal  in  the  primary  body  frame.  The  matrix  I\ 
is  the  primary  body  inertia  tensor  in  the  primary  body  frame,  I2  denotes  the  second  body 
inertia  tensor  with  reaction  wheels,  and  I3  is  the  diagonal  matrix  of  wheel  inertias. 

4.4  Simulation  Example:  Slewing  in  the  Plane 

Consider  a  rigid  body  with  a  flexible  appendage  attached  which  is  restrained  to  motion  in  the 
x  x  z  plane  which  means  that  =  0.  In  addition,  we  assume  that  axial  beam  vibrations 
are  negligible  so  that  773  =  z,  and  that  the  translational  velocity,  R,  is  also  negligible.  A 
control  torque  T\,  is  applied  to  the  rigid  body. 


Figure  4.2:  Rigid  Body  with  Flexible  Appendage 


beam  expander 


Figure  4.3:  Hinged  Bodies  with  Flexible  Appendage 
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The  formulation  of  the  equations  of  motion  follows  the  procedure  outlined  previously. 
The  system  Lagrangian  L  =  T  —  V  can  be  obtained  by  reduction  of  (4.21 )— (4.22)  under  the 
above  assumptions  to  the  form 

L  =  \h^b  +  2  [  {tu-’i>(~  ~  r?)  +  VtYpA  +  +  9t)2pl}dz 

Jo 

-  1  Jl  {EI(9:)2  +  kG. 4(7/,  -  0)2}  dz  (4.31) 

and  the  virtual  work  expression  is 

SW  =  Tb  S9b. 

Notational  conventions  for  the  planar  model.  In  the  rest  of  this  section  we  substitute 
the  symbol  rj  for  the  first  component  of  the  lateral  deflection  rjx  in  an  abuse  of  notation. 
Whereas  f>  denotes  the  rotational  deformation  of  the  appendage  we  denote  by  9b  ( uib )  the 
primary  body  attitude  angle  (resp.  angular  rate). 

Notice  that  the  configuration  space  is  Sl  x  Hg,  with  generalized  coordinates  9b  G  51, 
(r/.9)  G  Hg,  and  the  geometric  boundary  conditions  are 

Q  :  77(0,<)  =  0  an<J  ^(0,0  =  0. 

Thus  following  the  previous  approach  the  evolution  equations  can  be  written 

h^'b  +  f  {~(7tt  +  ^'b~  +  UJbTl)pA  +  {uJb  +  9tt)pl}d:  —  Tb  (4.32) 

Jo 

P-Mltt  +  d>bz  +  u>b2  77)  -  cXTjt  -  03(77,,,  -  9t:)  +  kGA(t).:  -  9Z)  =  0  (4.33) 

pl(uib  +  9tt)  ~  c29t  -  03(77,,  -  9t)  -  cA6tz.  +  EI6z:  -  kGA(tj.  -  9)  =  0  (T34) 

with  natural  boundary  conditions 

M  :  its{(.t)-9{(,f)  =  0  and  9.((,t)  =  Q.  (4.35) 

4.4.1  Finite  Dimensional  Model  for  Planar  Slewing 

From  the  discussion  in  Section  3  we  some  care  must  be  exercised  in  introducing  finite  di- 
mensional  approximation  of  the  DPS  by  discretization  of  the  spatial  coordinates  so  that 
the  resulting  finite  dimensional  evolution  model  approximates  the  evolution  dynamics  of  the 
continuous  system.  One  consequence  of  these  remarks  is  that  direct  spatial  discretization  of 
the  DPS  evolution  equations  ( 4.32 )— (4.35 )  is  not  recommended.  Rather  the  recommended 
approach  is  to  approximate  the  system  Lagrangian  (4.31)  by  FEM  and  then  develop  the  finite 
dimensional  evolution  model  by  applying  variational  arguments  to  the  reduced  Lagrangian. 

For  control  system  design  we  are  ultimately  interested  in  the  stability  of  certain  equilibria 
of  DPS  and  the  asymptotic  convergence  rates  near  these  equilibria  under  the  influence  of 
exogenous  (control)  forces.  For  these  purpose  useful  finite  dimensional  models  must  include 
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some  provisions  for  modeling  system  dissipation.  Our  approach  is  to  introduce  an  approx¬ 
imate  Rayleigh  dissipation  function  defined  on  a  finite  dimensional  subspace  of  the  state 
space  for  the  DPS  which  approximates  a  function  of  the  form 

RitJtiQt)  =  2  [  Ci Vt  +  C2 &t  +  (3{Vtz  —  &t)2  +  C4 @t  dz  (4.36) 

Jo 

which  can  be  obtained  directly  from  (4.27)  under  the  above  assumptions. 


4.4.2  Reduced  Order  Modeling  by  FEM  and  B-splines. 

Our  approach  to  finite  dimensional  modeling  is  based  on  the  use  of  B-splines  and  the  FEM. 
Recall  that,  a  B-spline  (or  basis  spline)  of  order  k  introduces  an  approximation  to  the  appro¬ 
priate  distributed  parameter  of  the  form, 

N  +  k- 1 

V  (  =  •<)*  E  V>(t)Blk(z)  (4.37) 

1 — 0 


where  N  is  the  number  of  spline  sections  (finite  elements).  The  B-splines  of  increasing  order 
are  defined  recursively  as 


Bf(z) 


-t+fc+i  —  - 
t + ^  1  +  l 


B 


fe-i 
t+ 1 


(-) 


(4.38) 


with  the  order  0  spline  defined  with  continuity  from  the  left; 


£?(-') 


1,  if  .r,  <  x  <  x,+i 
0,  else 


(4.39) 


The  ‘coefficient.’  functions  are  to  be  eliminated  by  application  of  certain  interpolation 
conditions  at  the  knots  together  with  the  geometric  boundary  conditions. 


Remark:  For  discretization  of  the  system  Lagrangian  (4.31)  and  the  Rayleigh  dissipation 
(4.36)  we  see  that  order  1  B-splines  (i.e.  linear  splines)  are  all  that  is  required.  This  is  not 
obvious  if  one  attempts  to  discretize  the  DPS  model  (4.32)— (4.3-5). 

The  required  interpolation  conditions  are  given  at  N  uniformly  spaced  knots  on  the 
spatial  interval  0  <  r  <  (\ 

V(x)  =  i(^) 

t=o  •/v 

1(2*)  =  Ei,S,l_1(2^) 

1  =  0  iV 

v(t)  =  Ei 

1  =  0 


(4.40) 
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together  with  the  geometric  boundary  condition 

7/(0)  =  £  ViBUO).  (4.41) 

t  =  0 

Let  rjit  =  i}(kL/ N)  for  k  =  0, 1, ... ,  N,  and  denote 


Then  we  can  write  the  N  +  1  interpolation  conditions  in  matrix  form  as 

7/  =  M  77,  (4.42) 

where 

BT(2jf) 

M  =  ;  ,  (4.43) 

bt(() 

BT(  °) 

B’-iU) 

B^(r) 

5(,)=  °.  (4.44) 

.  ^_,(S)  . 

Now  we  use  (4.42)  to  eliminate  77  from  (4.37)  to  obtain, 


t l(z,t)  *  BT(z)M~1fj  =  [Mx,M2]  q  j 

=  Br(-)A/i^(0  (4.45) 

Similarly  we  obtain  an  approximation  to  the  rotational  generalized  coordinate  as 

BT(z)AIl9(t).  (4.46) 

In  the  sequel  we  use  the  notation 

*T(z):=BT(z)Mu  (4.47) 

a  1  x  A’  array.  We  note  that  the  jV-vectors  77  and  0  represent  the  spatial  solutions  at  the  knots 
and  satisfy  the  interpolation  conditions.  The  spline  is  continuous  up  to  its  first  derivatives. 

For  this  simple  model  the  interpolation  conditions  and  geometric  boundary  conditions 
result  in  a  simple  relation  for  the  elements  of  <1*  since 

‘  0 

M  =  i  In 
1  0. .  .0 
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so  that 

ir  f  ° ...  o  1 

Mr  = 

■In 

thus 

(4.48) 

Now  using  (4.48)  together  with  (4.45)  and  (4.46)  we  can  approximate  the  System  Kinetic 
Energy ; 

T  =  Trtgid  +  Tflex , 

(4.49) 

frigid  —  2  ^^b 

(4.50) 

Tflex  =8  knT +  ubN*hJ1T}  +  \ujyT N^y  +  Ne0  4-  ^bNfe0 

(4.51) 

where 

N„  =  I'  pA$(z)<f>T(z)dz 

Jo 

(4.52) 

NWh  =  [\z2pA  +  pI)dz 

Jo 

(4.53) 

Kn=  =  fpAz*T{z)dz 

Jo 

(4.54) 

No  =  I'  pIM  =  )$T(:)  dz 

Jo 

(4.55) 

(4.56) 

the  System  Potential  Energy 

V  \0T K oB  +  \if I<ny  +  yT Kie0, 

(4.57) 

where 

Krr  =  [l  KGA$:(z)$T(z)dz, 

Jo 

(4.58) 

Ko  =  j'{EI$z(z)$Tz(z)  +  KGA$(z)$T{z)}  dz, 

(4.59) 

KnO  =  -  ['  KGrA<f>z(z)<l>T(z)dz, 

Jo 

(4.60) 

and  Syste 

m  Dissipation  Function 

'  T  ' 

R  \yT Bn t/  +  \0  BoB  +  if  BnoB, 

(4.61) 

where 

Bn  =  Av ^(  =  )^T(z)  +  (:^z(z)^(  =  )}dz,  (4.62) 

Jo 

Bo  =  j'{(C2  +  C3)$(z)$T(z)  +  <;<$z(z)*T(z)}dz,  (4.63) 

Bno  =  ~  ['<;3*Az)*T(z)dz. 

J  0 


(4.64) 
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The  parameters  (1,(2  represent  external  dissipation  (e.g.  viscous  damping)  and  (3,(4  model 
internal  (e.g.  material)  dissipation  [BK89]. 

Solving  the  Lagrange’s  equations  in  terms  of  the  finite  dimensional  generalized  coordi¬ 
nates; 


d 

dT 

d{T  - 

V) 

+ 

OR 

dt 

dojh 

dBh 

dujb 

d 

dT 

d(T- 

V) 

1 

dR 

Tt 

dij 

df) 

+ 

dij 

d 

dT 

d(T- 

V’) 

1 

dR 

dt 

d'e 

dB 

“T 

d'e 

= 

=  0, 

=  0, 

gives  the  finite  dimensional  model  evolution  equations, 

[M^,  4-  fjT 4-  N^infj  4-  NlJ  -f  u>bfjT Nrjfj  =  T),, 
Nnfj  -f  tviyNu^n  —  T  Rntj  4  4-  Bnfj  4-  B^gO  =  0, 

NgB  4-  a)bNuh6  4-  Rg8  4"  4-  Bg9  4-  B^gfj  =  0, 


(4.65) 


(4.66) 

(4.67) 

(4.68) 


where  the  effective  rigid  body  inertia  for  the  undeformed  elastic  appendage  state  is 


Mu  —  4"  ArW(l. 


To  compute  the  coefficients  of  the  resulting  reduced  order  model  equations  in  terms  of 
the  DPS  physical  model  parameters  we  must  evaluate  the  integrals  in  ( 4 . 52 )— ( 4 . 56 ) ,  (4.58)- 
(4.60),  and  ( 4 . 62 )— ( 4.64 ) .  For  initial  simulation  studies  we  assume  the  elastic  appendage 
is  a  uniform  beam  and  take  pi ,  pA,  E I ,  kGA  constant  over  c  €  [0,  €].  Later  this  will  be 
modified  to  model  the  spatial  variation  in  cross  section  and  moment  of  inertia  associated 
with  a  typical  pyramidal  shaped  secondary  mirror  support  structure  for  typical  laser  beam 
expander  for  a  space  based  laser. 

Under  these  assumptions  we  can  obtain  an  N  x  N  matrix 

N  =  I'  $(z)$T(z)  dz 
Jo 

with  elements  of  the  form 

[N]ij=  I'  Bi1(z)B]_l(z)dz,  for  =  1 . TV. 

J  0 


A  straightforward  computation6  obtains  the  tridiagonal  structure  of  N  with  elements, 


i(£),  for  i=j  =  N 
lijih  for  i  =  j  <  N 
e(£)-  for  t  =  j±  1 
0,  else 


(4.69) 


c'See  Appendix  B  for  details. 
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Similarly,  we  obtain  the  N  x  N  tridiagonal  matrices 


N'  =  f(  $;(z)<f>T(z)dz, 
Jo 

A"  =  [‘ i;(z)*T(z)  dz, 

Jo 


(4.70) 

(4.71) 


with  elements  given  by 


(?).  for  i  =  j  =  N 
fv'i  2(f),  for  i  =  j<N 

['V|w=  -(|),  for  i  =  >  ±  1  ' 

0,  else 

0,  for  i  =  j 

4  ZWj-i  ■ 

0,  else 

With  these  relations  we  can  express  the  model  coefficient  matrices  as  follows: 

N„  =  pAN 
Ne  =  pIN 
K„  =  kGAN' 

Ko  =  EIN'  +  kGAN 
R\o  =  -kGAK' 

Bn  =  GN  +  CzN' 

Be  =  (C2  +  (3 )  N  4-  (4  A" 

B„e  =  -43A". 


(4.72) 


(4.73) 


Similarly  the  1  x  N  matrices 


C,  =  pA^ziT(,)dz. 

=  Pi  jAT{  =  )d=. 


can  be  reduced  to  the  form 


= 


T  _  \t_  l_  (_  J_  I 

J  U",9  P  \N'N'"''N'2 N'' 


M(l  +  i)(£)2.  for  i  =  1, . . . ,  rV  —  1 


1  {  M(£)2[?  -I),  (or  i  =  N 

Finally,  we  obtain  by  direct  integration  of  (4.53)  under  the  above  assumptions  that 


(4.74) 

(4.75) 


(4.76) 


(4.77) 


N„h  =  p  A—  +  pit. 


(4.78) 
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5  Normal  Forms,  Decoupling  and  Partial  Linearization 

5.1  Partial  Linearization  and  Stabilization  of  Nonlinear  Systems 

Techniques  for  stabilization  of  nonlinear  systems  via  feedback  control  are  still  very  limited 
and  tend  to  be  tailored  to  specific  situations.  Among  the  most  promising  general  approaches 
are  based  on  global  linearization  by  Exact  Feedback  Linearization  (EFL)  [HSM83,  KC87], 
The  methods  are  based  on  earlier  work  of  Krener  [Kre73]  and  Brocket!  [Bro78]  which  demon¬ 
strate  that  a  large  class  of  nonlinear  dynamical  systems  can  be  exactly  (i.e.  globally  lin¬ 
earized)  by  a  combination  of  nonlinear  transformation  of  the  state  coordinates  and  nonlin¬ 
ear  state  feedback.  More  recently  the  connection  between  these  methods  and  the  idea  of 
input-output,  (or  partial)  feedback  linearization  (PEL)  by  construction  of  a  system  inverse 
( Hi r 7D]  has  been  articulated  in  a  series  of  papers  by  Byrnes  and  Isidori  { B 185 ,  BI84j.  These 
connections  have  engendered  a  series  of  design  methods  with  representative  results  for  spe¬ 
cific  applications  bv  Kravaris  and  Chung  [KC87]  and  Fernandez  and  Hetrick  [FH87].  In  this 
section  we  will  summarize  these  results  and  then  proceed  to  develop  the  method  for  the  case 
of  multibody  systems  from  the  perspective  of  Lagrangian  mechanics. 

Partial  linearization  derives  directly  from  the  Byrnes-Isidori  normal  form  for  nonlinear 
systems.  The  essentials  of  the  approach  are  most  easily  developed  for  single-input,  single 
output  systems  and  we  will  present  the  approach  in  that  context.  The  theory  for  extending 
these  results  for  multi-input,  multi-output,  problems  is  now  complete  and  references  are 
included. 

Consider  a  nonlinear  dynamical  system  in  the  form. 


x  =  /(.r)  +  g(x)u 

V  =  h(x) 


(5.1) 

(5.2) 


where  /, g  are  smooth  C,oc  vector  fields  on  5Rn  and  h  is  a  smooth  function  mapping  f?"  — > •  9?. 
Now  if  we  differentiate  (5.2)  we  obtain 


c^h. 

y  =  +  ?(*)«)• 

ox 


(5.3) 


In  the  case  that  the  scalar  coefficient  of  u  (viz.  ~g(x))  is  zero  we  can  differentiate  again  until 
a  nonzero  control  coefficient  appears.  The  number  of  required  differentiations  is  fundamental 
system  invariant  which  plays  a  role  in  constructing  system  inverse  and  therefore  in  partial 
linearization.  The  Byrnes-Isidori  analysis  shows  that  this  integer  number  is  analogous  to  the 
relative  degree  for  a  linear  system  [BI84] . 

The  above  construction  can  be  made  precise  using  the  notation  of  differential  geometry 
which  has  found  application  in  analytical  mechanics  [ Arn78] .  We  will  need  only  the  notion 
of  Lie  derivative  and  Lie  bracket.  The  Lie  (directional)  derivative  of  the  scalar  function  h 
with  respect  to  the  vector  field  /  is 


Lf(h)  =  (dh,  f) 


dh 

dx 


fix)- 


(5.4) 
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Since  the  above  operation  results  in  a  scalar  function  on  3?n,  higher  order  derivatives  can  be 
successively  defined 

£/(M  =  L,(Llf-'(h))  :=  {iL)-\h),f).  (5.5) 

Then  we  can  write  (5.3)  as 


y  =  (dh,f)  +  (dh,g)u 

=  Lf(h)  +  Lg(h)u.  (5.6) 

If  Lg(h)  =  0  then  we  differentiate  again  to  obtain 

V  =  {dLf(h)'f)  +  (dLf(h),g)v 

=  I5(fc)  +  ltf(l/(fe))tt.  (5.7) 


If  Lg(Lkj  '(/;))  =  0  for  A:  =  1 . r  —  1,  but  Lg{LTf  ’(A))  ^  0  then  the  process  terminates 

with 

=  i;(/o  +  i3ur1(/i))u-  (5-8) 

The  system  (5.8)  can  be  effectively  inverted  by  introducing  a  feedback  transformation  of  the 
form 

“•9) 

which  results  in  an  effective  input-output  system  from  r  — *■  y  given  by 

Jry 


dtr 


=  v 


a  linear  system. 

The  integer  r  >  0  is  called  the  relative  degree  of  the  nonlinear  system  (5.1 )— ( 5.2).  Note 
that  if  we  define  new  state  coordinates  c  €  9?n  as 


zk  =  L)~l{h),  k=  1 . r 


(5.10) 


then  the  nonlinear  system  (5.8),  as  obtained  from  the  previous  procedure,  can  be  written  in 


the  form 


where 


0 

'  0 

1 

0  • 

•  0  ' 

0 

0 

0 

1  • 

•  0 

s  + 

0 

0 

0  • 

•  1 

0 

0 

0 

0  • 

•  0 

a(x)  +  p(x)u 

a(x)  =  L){h),  p[x)  =  Lg{L)-\h)). 


(5.11) 


(5.12) 


More  generally,  using  the  new  coordinates  r  (5.10)  and  introducing  a  nonlinear  feedback 


control  of  the  form 


{v  -  <7(r)) 


P(*) 


u  — 


(5.13) 
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where 

r  —  1 

(t{x)  ~'Y^3kL){h)  +  Uf(h),  (5.14) 

fc  =  o 

p(x)  =  Lg(Lyl(h)).  (5.15) 

with  -h-  for  A’  =  0 . r  -  1  real  positive  coefficients  then  the  equations  (5.6)— (5.7)  can  be 

written  in  reduced'  form; 


’  0 

l 

o  •• 

0  ‘ 

(  °  \ 

0 

0 

l  •• 

0 

0 

z  — 

n 

n 

0 

0 

~  “I" 

.  -A 

-ft 

-02  .. 

~0r-l  . 

V  i  / 

y  =  [1,0 . 0\z.  (5.17) 


Nonlinear  System  Transmission  Zeros  Note  that  the  process  leading  to  (5.16)— (5. 17) 
provides  an  equivalent  state  space  realization  for  the  input-output  map  of  McMillan  degree 
strictly  less  than  n  (the  dimension  of  the  original  state  space  model  (5.1 )— ( 5.2) )  by  decoupling 
a  portion  of  the  system  dynamics  from  the  output  response.  This  is  depicted  in  Figure  5.1. 
Thus  the  new  state  coordinates  z  are  a  'partial'  state  for  the  system.  Thus  stabilization  of 
(5.  l<i)-(5.!7)  cannot  guarantee  stabilization  of  the  full  state  model  (5.1 )— ( 5.2). 

Byrnes  and  Isidori  [BI85]  describe  the  above  construction  leading  to  a  system  normal 
form  in  the  form  (5.16)— (5.17)  from  which  complete  stability  results  can  be  obtained.  The 
main  result  provides  the  existence  of  a  transformation  of  coordinates  ,r  —  (£,-),  with  the 
state  partition  in  the  new  coordinates  f  £  3?n-r.  r  £  sFr  so  that  the  full  state  representation 
in  the  new  coordinates  is  in  normal  form; 

i  =  F(Z,z).  (5.18) 

[£(£,-)  +  r(£,c)tt],  (5.19) 

wdiere  3(f.z)  =  a(x(f,  :))  and  r(£,  z)  =  p(x(f,  :)).  Thus  we  can  define  zero  dynamics  of  the 
original  system  (5.1)— (5.2)  as  the  autonomous  system 

Z  =  Ftf,  0).  (5.20) 


0 

0 


/  r-l 
0 


-f- 


Partial  Linearization  for  Lagrangian  Systems  Despite  the  apparent  simplicity  of  de¬ 
termining  the  zero  dynamics  from  the  normal  form  as  above  it  is,  however,  quite  complex  to 
compute  the  complete  transformation  leading  to  the  full  state  normal  form  as  given  above. 
One  approach  (if  possible)  is  to  obtain  the  full  state  exact  linearizing  transformation  via  the 
procedure  given  by  Hunt,  Su,  and  Meyer  [HSM83]  which  requires  the  solution  of  a  set  of  si¬ 
multaneous  partial  differential  equations.  However,  in  many  special  cases  the  zero  dynamics 
as  well  as  the  required  transformations  for  partial  linearizing  control  can  be  obtained  more 
directly.  In  the  sequel  we  discuss  the  required  constructions  for  Lagrangian  systems. 
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Consider  the  case  of  a  square  Lagrangian  system  with  inputs  r  £  ??m  and  outputs  y  £ 
Suppose  that  the  n  generalized  coordinates  can  be  partitioned  into  components  71  £  9im  and 
72  ^  W”-"1  so  that  the  equations  of  motion  take  the  form 


d 

dL 

dL 

dt 

dqi 

dqi  ~  T ' 

(5.21) 

d 

dL 

dL  n 

dt 

dq2 

-  -z-  =  °, 
dq2 

(5.22) 

y  = 

=  h(quq2). 

(5.23) 

Assume  that  the  origin  is  an  equilibrium  point  with  r  =  0,  /? ( 0, 0 )  =  0.  and  that  the  Jacobian 
dhidi i\  is  nonsingular  on  some  neighborhood  of  the  origin.  Furthermore,  we  assume  that 
the  Lagrangian  is  a  positive  definite  quadratic  form  in  the  generalized  velocities.  Then  the 
input-output  map  ( 7-  — •  t/ )  has  relative  degree  2  (locally),  a  PLF  control  exists  and  the 
zero  dynamics  may  be  computed  by  a  relatively  simple  coordinate  transformation  applied  to 
(5.21 )  (5.23). 

In  order  to  demonstrate  these  properties  we  introduce  a  change  of  coordinates  (71.72)  •— * 
(y.  11)  via  the  relations 

y  =  h(quq2)y  u  =  72  (5.24) 

Note  that  the  assumption  dei  dh/dq\  ^  0  at  the  origin  assures  that-  this  is  a  valid  local 
coordinates  transformation  and  the  inverse  relations  can  be  given  as 


7i=  0(!/i  «),  72  =  »• 


(5.25) 


Since  any  “p0'0*  transformation  preserves  the  Lagrangian  structure  of  the  equations,  in  the 
new  coordinates  we  can  write  the  variational  problem  in  the  form 


£  dL 
dt  dy 

£  dt 

dt  dii 


dL  . 

Ty  =  r”r' 

dt  - 

=  rur, 

OU 


L(y,y,  1/,  h)  =  1(71.71.72,72)! 


mT  f  - 

dg 

[dy\  ' 

dv 

?i  =g(y. u),<?2  =  u 
^  i  T 


where 

and 


Equations  ( 5 . 26 )— ( 5.27)  reduce  to  the  form 

jvy  +  Nii  +  A'v(y,  y.  «,  ir)  =  fyr, 

NTy  +  JJt  +  A'u(y,  y,  w,  it)  =  Tur. 

Let  us  define  the  partitioned  matrices  £u,  $y, 'I>u,  via  the  relations 

(  E„  \  =  jy  N  l“l  f  ky  \ 

UJ  NT  ju  \  Ku  I 


(5.26) 

(5.27) 

(5.28) 

(5.29) 


(5.30) 

(5.31) 


(5.32) 
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and 


Note  the  choice  of  control 

r  =  ^1{Sy  +  i.}  (5.34) 

reduces  { 5 . 30 )— ( 5.31)  to 

y  =  v  (5.35) 

NT{y,  u)y  +  Ju(y,  u)il  4-  K(y,  y,  u.  u)  =  fu(y,  u)$~'(y,  u){Sv(y,u)  +  u}  (5.36) 

where  we  have  explicitly  displayed  the  dependence  of  the  model  parameters  on  the  generalized 
coordinates.  Equation  (5.35)  provides  the  linearized  input-output  dynamics  and  the  zero 
dynamics  are  obtained  from  (5.36)  upon  setting  y(t)  =  0,  which  implies  y  =  0,y  =  0,  and 
r  —  0.  Thus,  we  obtain  the  zero  dynamics  in  the  form 

ju(0,  u)u  +  A"(0, 0,  u ,  u )  -  f  u(0,  u  )$~1(0,  u)Sy(0,  u)  =  0  (5.37) 

which  represents  an  autonomous  nonlinear  dynamical  system  in  the  state  coordinates  u,  it. 
We  say  the  system  is  locally  minimum  phase  if  the  origin  in  the  (u,u)  coordinates  is  a 
stable  equilibrium  for  (5.37).  If  the  system  is  minimum  phase  then  selecting  the  control  v 
to  stabilize  the  origin  of  (5.35)  guarantees  stability  of  the  origin  of  the  dynamical  system 
(5.21 )— ( 5.23).  Thus  the  computational  complexity  of  obtaining  the  zero  dynamics  depends 
on  the  complexity  of  the  required  inverse  relation  g  in  (5.25). 

In  the  next  section  we  indicate  the  importance  of  this  approach  to  nonlinear  control 
system  design  lor  rapid  reorientation  (slewing)  of  a  flexible  space  structure. 

6  Rapid  Slewing  Control  for  Flexible  Space  Structures 

A  primary  measure  of  system  performance  for  an  SBL  weapon  system  is  its  retargeting 
envelope  consisting  of  achievable  changes  in  LOS  angle  and  required  minimum  slewing  time 
for  a  given  maximum  torque  capability.  For  system  torque  sizing  a  time-optimal  control 
maneuver  is  usually  assumed.  Since  the  ideal,  time-optimal  acceleration  waveform  is  a 
discontinuous,  bang-bang  control,  achievable  performance  is  typically  limited  by  actuator 
slew  rate  limiting.  For  precision  optical  systems,  elastic  interactions  from  spacecraft  and 
optical  system  support  structure  may  limit  achievable  slewing  times  and  retargeting  angles 
well  before  actuator  slew  rate  limiting  becomes  a  factor.  Structural  excitation  will  ultimately 
limit  fine  pointing  precision  and  optical  component  alignment  and  will  increase  effective 
system  slew  times. 

In  this  section  we  describe  the  application  of  PFL  and  decoupling  control  for  rapid 
slewing  of  a  flexible  space  structure.  We  consider  slewing  of  the  system  principal  LOS  while 
decoupling  the  system  elastic  response.  Our  benchmark  problem — as  described  in  a  previous 
section — is  motivated  by  the  elastic  interactions  due  to  structural  deformation  in  a  metering 
truss  of  a  typical  optical  beam  expander  for  a  SBL  system.  Initially,  we  consider  LOS  defined 
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in  terms  of  principal  body  attitude  and  consider  the  limits  of  achievable  performance.  Next 
we  refine  the  definition  of  optical  LOS  to  include  relative  alignment  of  optical  components 
subject  to  structural  deformation  dynamics.  We  indicate  how  to  utilize  available  optical 
steering  mirror  components  to  compensate  for  structural  interaction  contributing  to  a  well 
defined  system  LOS.  Simulation  results  for  a  simple  planar  dynamical  model  are  provided 
based  on  the  finite  element  model  developed  in  a  previous  section  and  using  available  system 
parameters  for  a  typical  SBL  benchmark. 

6.1  Slewing  Control  for  Principal  Body  LOS 

To  illustrate  the  application  of  nonlinear  PFL  we  focus  on  the  simple  planar  model  for  slewing 
developed  in  section  3.4  and  given  by  equations  ( 4.32 )— ( 4 .35 ) .  Consider  a  typical  optical  train 
for  a  laser  beam  expander  as  shown  in  Figure  6.1.  Various  options  for  a  support  structure  for 
the  secondary  mirror  (metering  truss)  are  considered  in  the  system  study  [Lea87].  Clearly, 
flexure  response  of  the  metering  truss  is  an  issue  of  dominant  concern  affecting  the  optical 
system  alignment,  including  focusing  and  LOS  pointing.  The  model  equations  ( 4 .32 )— ( 4.35) 
can  be  readily  adapted  to  characterize  the  principal  dynamics  of  this  system  under  the 
assumption  of  planar  motion  and  assuming  the  metering  truss  is  the  primary  source  of 
structural  flexure  affecting  LOS  pointing. 

Initially,  we  approximate  the  elastic  deformation  of  the  metering  truss  using  a  uniform 
beam  model  and  take  the  structural  parameters  £,  /,p,  .4,  kG  as  constant  over  the  length  of 
the  truss  0  <  z  <  L  For  our  simple  planar  slewing  model  we  take  as  a  model  for  the  system 
effective  optical  LOS  as  Olos ■  given  by 

®ios  =  &b  +  ^los  (6.1) 

where  0b  is  the  principal  body  attitude  in  the  x  x  z  plane  and  &los  is  a  relative  LOS 
deflection  due  to  deformation  of  the  metering  truss  and  the  resulting  dynamic  misalignment 
of  the  secondary  mirror.  For  the  case  of  planar  motion  we  can  model  the  relative  LOS  as  a 
perturbation  of  the  body  LOS  resulting  from  angular  deformation  at.  the  secondary  mirror 
of  the  form. 

bios  =  2MO  +  0(t)}-  (6-2) 

This  simple  model  is  summarized  in  Figure  6.2. 

For  simulation  purposes  we  introduced  a  finite  element  model  for  this  system  in  sec¬ 
tion  3.3.1  given  by  equations  ( 4.66 )— (4.68).  Our  initial  considerations  for  rapid  slewing  are 
focused  on  attitude  reorientation  of  the  spacecraft  principal  body.  Thus  we  define  the  system 
output  as  y  ~  0b. 

To  obtain  the  PFL  transformation  we  proceed  as  for  Lagrangian  systems.  In  this  case  the 
required  change  of  coordinates  is  trivial  since  ( 4 .66 )— ( 4 . 68 )  are  already  in  the  form  (5.30)- 
(5.31)  with  respect  to  the  system  output  y  =  9b  and  u  —  [ij,0)T .  Thus  the  linearizing 
feedback  torque  can  be  given  immediately  from  (5.34). 

To  illustrate  the  simplicity  of  the  computations,  we  identify  the  model  equations  (4.66)- 
(4.6S)  in  the  form 

Mu)0b  +  NTU  +  Kg  =  Tb  (6.3) 


loser 
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Figure  6.2: 


Planar  slewing  model  for  optical  beam  expander 
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where 


A'u  = 

The  PFL  torque  is 
where 


M,il  +  NO  +  Ku  =  0 
Jo  =  A/^  +  fjT  Nnf] 


M.  = 


Nn  0 


iV 


0  N$ 

Kft  =  2 U.'bf}T  Nr,  fj. 


(Nr 


4K)  k 


A'5 


A'< 


iVu 

iV, 


Bn  Bn6 

BZ,  B, 


Tb  —  A#  A/u  (A/I2AU  -!-  r 


A/  = 


'  A/„ 

A/i2  ' 

■  Jo 

NT  ' 

.  a/21 

A 1 22 

N 

. 

Ms 

7 

9 


(6.4) 


(6.5) 


and  c  is  the  new,  synthetic  control  input.  The  nonlinear  feedback  transformation  linearizes 
the  input-output  map  from  v  ^  y  and  decouples  the  u  dynamics  so  that; 


V  =  t’- 

The  resulting  system  is  stable  if  and  only  if  the  decoupled,  zero  dynamics  are  stable.  In 
this  case,  the  zero  dynamics  are  readily  obtained  from  (6.3)  by  letting  9  — >.  0,  9  — 1  0,  0  — >  0; 

M,  u  -)-  A.j  =  0. 


which  is  the  (linear)  cantilevered  dynamics  of  the  flexible  appendage.  Clearly,  this  is  (practi¬ 
cally)  stable  as  long  as  sufficient  damping  (either  active  or  passive)  is  present,  in  the  structure. 

Design  of  time-optimal  slewing  of  the  decoupled,  linear,  9b  dynamics  is  now  straightfor¬ 
ward  and  practical  implementation  is  discussed  next. 


Pseudo-Time  Optimal  Control  of  Ideal  Rigid  Body  Inertia.  Time-optimal  slewing 
of  a  pure  inertia  subject  to  limited  acceleration  consists  of  a  bang-bang  acceleration  with 
constant  acceleration  up  to  a  switching  instant,  at  which  time  a  constant,  deceleration  is 
applied.  Implementation  of  time-optimal  control  for  a  pure  inertia  involves  determination  of 
a  switching  condition  for  the  ideal,  bang-bang  acceleration  (control).  For  feedback  control 
we  would  like  to  obtain  a  switching  surface  in  the  phase  plane  (9,9).  The  ideal  bang-bang 
control  is  discontinuous  with  respect  to  this  switching  surface. 

Trajectories  in  the  phase  plane  of  (#,$)  for  constant  acceleration  can  be  obtained  from 
the  flow  of 

9  —  CYmax 

with  otmar  a  constant.  The  required  switching  condition  is  defined  in  terms  of  a  switch¬ 
ing  surface  given  by  the  phase-plane  trajectory  approaching  the  origin  which  satisfies  the 
condition; 

2cw 9  ±  97  =  0 
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with  sign  depending  on  the  sign  of  amax.  For  ctmax  >  0  the  required  ideal  switching  surface 
is  given  by 

s(eJ)  =  2amaxe  +  m  =  o, 

and  the  ideal,  time-optimal  acceleration  is  a  switching  law  of  the  form, 

a  =  —  sgn{2ama;r6  +  #|0|}. 

Practical  application  of  the  above  control  is  limited  by  the  requirement  for  instantaneous 
torque  (acceleration)  switching  and  by  he  tendency  for  a  feedback  implementation  of  the 
above  form  to  limit  cycle  in  the  region  near  the  phase  plane  origin. 

A  practical,  pseudo-time-optimal  control  can  be  implemented  using  feedback  by  replacing 
the  requirement  for  instantaneous  switching  with  a  direct  limit  on  acceleration  slewing  rate. 
This  is  achieved  by  replacing  the  sgn  function  with  a  saturation  function  of  the  form, 

e  >  Q-rnax 

€,  |e|  ^  &max 

&max  i  ^  ^ 

The  pseudo-time-optimal  control  can  then  be  implemented  in  the  form, 

a  =  -sat{(71(/(w)  +  2omar0)}  (6.6) 

where  u;  =  0,  the  nonlinear  function  /(w)  is  a  piecewise  continuous  approximation  to  the 
ideal  quadratic  switching  surface 

(  u2+gl/4,  u>  >  g2/ 2 

/M  =  l  92^,  M  <  ^2/2  . 

i  -w2  -  g\! 4,  u>  <  -g2/2 

The  constant,  gain  g\  is  chosen  to  represent  slew  rate  limiting  in  the  torque  actuator  and  g2 
is  chosen  to  provide  stable  (damped)  pointing  response. 

Given  the  nonlinear  PFL  transformation  the  pseudo-time-optimal  control  can  now  be 
implemented  directly  for  principal  body  LOS  slewing  by  setting  v  =  a  in  (6.5)  with  a  given 
in  (6.6). 

6.2  Simulation  Results  for  Principal  Body  LOS  Slewing 

The  finite  dimensional  simulation  model  for  planar  slewing  is  now  used  to  illustrate  the  be¬ 
havior  of  the  combined  nonlinear  PFL  and  pseudo-time-optimal  control  given  by  (6.5).  (6.6) 
and  i'  =  a.  The  FEM  model  is  described  in  Section  3.4.2  and  is  based  on  physical  parameters 
given  in  Table  6.1  which  are  loosely  taken  from  the  system  study  [Lea87],  The  elastic  and 
shear  moduli  are  chosen  to  roughly  approximate  the  reported  first,  modal  frequency  of  the 
metering  truss  obtained  from  the  structural  analysis  of  the  benchmark  SBL  system  [Lea87]. 
The  internal  dissipation  parameters,  ((,'4)  were  chosen,  somewhat  arbitrarily,  as  small  frac¬ 
tions  (2%)  of  the  elastic  (resp.  shear)  modulus.  The  external  damping  coefficients  (1,(2 
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Parameter 

Value 

Description 

h 

1.325E+06 

principal  body  moment  of  inertia 

i 

15. 

length  of  appendage 

p 

1520. 

mass  density  of  appendage 

A 

0.01298 

cross  section  area  of  appendage 

E 

1.6E+07 

appendage  elasticity  modulus 

kG 

6.4E+06 

appendage  shear  modulus 

I 

693.11 

appendage  area  moment 

Ci*  C2 

0.0 

external  dissipation  coefficient 

1661.44 

internal  dissipation  coefficient 

C4 

0.222E+09 

internal  dissipation  coefficient 

Table  6.1:  Physical  Parameters  for  Simulation  Model  (in  MKS  units) 


mode 

frequency  (r/s) 

mode 

frequency  (r/s) 

1 

6.8167991 

7 

64.716684 

2 

19.996775 

8 

73.055738 

3 

20.941475 

9 

87.662067 

4 

36.418957 

10 

91.188281 

5 

41.217664 

11 

118.80496 

6 

54.057492 

12 

139.11817 

Table  6.2:  Undamped  Frequencies  of  Cantilevered  Appendage  Dynamics 
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are  set  to  zero  to  simulate  space  environment.  The  resulting  undamped  frequencies  of  the 
cantilevered  appendage  dynamics  are  given  in  Table  6.2. 

The  resulting  response  in  principal  body  LOS  Of,  for  N  =  5  finite  elements  is  shown  in 
Figure  6.3  for  a  30  degree  slew.  The  commanded  ideal  LOS  acceleration  a  obtained  from 
(6.6)  with  0  =  Of,,  uj  =  ust,  is  shown  in  Figure  6.4.  The  required  linearizing  torque  T&  obtained 
from  (6.6)  is  shown  in  Figure  6.5.  Clearly,  substantial  additional  torque  capability  is  needed 
to  implement  the  exact  PFL  control  and  decouple  the  effect  of  the  flexible  appendage  on  the 
rigid  body  attitude.  A  principal  focus  of  the  FY89  project  will  be  to  investigate  options  for 
approximating  the  PFL  torque  so  that  both  torque  authority  and  torque  bandwidth  can  be 
relaxed.  See  the  appendix  on  Slew  Induced  Deformation  Shaping. 

For  optical  LOS  slewing  the  resulting  relative  LOS  A los  given  in  (6.2)  will  also  be 
of  concern.  Figure  6.6  displays  the  response  in  A  los  as  obtained  in  (6.2)  for  the  simple 
planar  slewing  model.  Clearly,  excessive  deformation  of  the  secondary  mirror  orientation  will 
degrade  the  optical  LOS  after  the  completion  of  the  primary  body  LOS  slewing  maneuver. 
In  the  next  section  we  describe  a  method  for  decoupling  and  PFL  for  the  effective  optical 
LOS  in  addition  to  the  primary  body  attitude  by  introducing  additional  control  capability. 

6.3  Optical  LOS  Slewing  using  Steering  Mirror  Compensation  for  Structural 
Deformation. 

For  rapid  slewing  and  precision  pointing  of  space-based  optical  systems  and  essential  consid¬ 
eration  is  structural  interaction  with  the  optical  train  alignment  and  resulting  degradation 
of  system  performance.  With  respect  to  the  benchmark  model  of  the  laser  beam  expander 
we  focus  on  the  relative  alignment  of  the  primary  and  secondary  mirror  due  to  elastic  defor¬ 
mation  of  the  metering  truss.  Throughout  this  study  we  have  assumed  that  the  introduction 
of  active  structural  control  on  the  metering  truss  is  precluded  by  considerations  of  optical 
path  occlusion  from  expanded  cross  section  of  the  truss  members  with  additional  control 
components.  The  system  study  [Lea87]  considers  various  options  for  truss  configurations 
and  strut  material  but  does  not  consider  active  control  of  the  truss. 

It  is  easy  to  show  that  PFL  of  the  simple  model  of  effective  system  optical  LOS  given  in 
(6.1)  using  the  rigid  body  torque  7j,  only  is  not  feasible  because  the  system  response  from  7j, 
to  9los  is  nonminimum  phase.  This  is  an  essential  characteristic  of  distributed  parameter 
models  for  structural  dynamics  with  one  or  more  spatial  dimensions.  As  is  well  known  for 
the  case  of  linear  models  for  such  systems  the  response  from  generalized  force  control  to 
position  output  will  be  minimum  phase  only  if  the  point  of  control  and  observation  are 
spatially  colocated.  However,  in  this  case  additional  control  degrees  of  freedom  are  available 
using  the  optical  system  components.  Referring  to  Figure  6.1  the  optical  steering  mirrors 
are  included  to  provide  fine  pointing  adjustment  of  the  optical  LOS. 

Consider  a  simple  model  of  the  effect  of  relative  angular  motion  of  the  steering  mirror, 
9m.  on  the  system  relative  LOS  (measured  in  the  primary  body  fixed  frame)  given  by, 

Alos  =  2{t/;(C)  +  9{£)}  -  29m.  (6.7) 

We  assume  that  the  steering  mirror  is  mounted  on  the  primary  body.  Its  dynamic  interaction 
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with  the  body  is  given  by  the  modified  equations  of  motion  (for  the  reduced  order  model); 

[M*  +  iT  +  Imum  +  N^fj  +  N*hl)$  +  ujhif  N^fj  =  Tb ,  (6.8) 

Im(^b  ~  ^m)  =  Tm ,  (6-9) 

Nnfj  +  uibNUhn  -  udIN^v  +  Krjfj  +  Kn9$  +  B^t}  +  Bn00  =  0,  (6.10) 

N,S  +  4-  K$9  +  h^Bfj  4-  BgO  +  B^gfj  =  0,  (6.11) 

where  fm  is  the  steering  mirror  inertia  and  Tm  is  the  control  torque  applied  to  the  steering 
mirror  in  the  body  frame.  We  have  assumed  a  frict.ionless  mount. 

We  now  show  that,  the  two-input.,  two-output  system  from  ( Tb,Tm )  (9b. 9m)  is  relative 


degree  2,  minimum  phase,  and  can  be  linearized  by  PFL  transformation.  Furthermore,  the 
resulting  PFL  response  is  decoupled  in  the  sense  that  after  the  introduction  of  nonlinear 
feedback  the  response  from  the  new  synthetic  inputs  (t>i,v2)  h— ‘  (9b.  9m)  is  of  the  form, 

9b  =  t’i 

9m  =  t’2- 

To  compute  the  2-input/2-output  PFL  torques  we  identify  a  transformation  of  the  gen¬ 
eralized  coordinates; 

Vi  =  9b  (6.12) 

V7  =  2{ris(t)  +  9(C)}-29m.  (6.13) 


From  the  finite  element  model  described  in  Section  3.4.2  we  can  see  using  B-splines  that,  the 
local  slope  is  obtained  as, 


(9$r(c) 


=  -(?)VN(t), 


(6.14) 


:  =  ( 


so  that,  we  obtain  the  relative  LOS  for  the  finite  element  model  in  the  form, 


A los  ~  2{ [0, ...  ,0,  — (t))’7  +  [0 —  ,0, 1)0}  -  20m, 

=  c^  +  cj9-29m.  (6.15) 

From  the  above  we  can  rewrite  the  modified  system  equations  of  motion  in  terms  of  the 
new  generalized  coordinates  yi,t/2  and  using  the  FEM  LOS  approximation  as, 

[A/a,  +  fjTNvfj)y !  -  \Imy2  +  +  [Ad,*  + 


4- 2 yxrjT Nnij  =  Tb,  (6.16) 

Imyi  +  klmy 2  -  ImC*n  -  ImcT99  =  Tm.  (617) 

N, j  4-  y\NUhr,  -  y] Nnfj  +  Kny  +  Kn99  +  Bnrj  +  B,}e9  =  0,  (6.18) 

N$9  -f  yiNWk9  4  K99  4-  h^fj  4-  B99  4-  B^fj  =  0.  (6.19) 
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Then  the  required  decoupling  torques  7&,  Tm  can  be  obtained  directly  from  the  above 
equations  in  the  form 

Tb  =  [Ajhr)  +  ]v  +  +  ImCg}0  +  2yxfjT  Nnfj 

+  [Mu  +  fjT  N^Cli  ~  \IrnO-2,  (6.20) 

Tm  —  -Imc*rj  —  Imcj9  +  Ima  i  +  i/ma  2-  (6-21) 

The  required  slewing  controls  can  now  be  generated  for  the  decoupled  dynamics  of  the 
principal  body  LOS  y\  =  9b  and  relative  (body  frame)  LOS,  t/2  =  A los  exactly  as  before. 

Remark.  In  this  form  it.  is  clear  that  the  PFL  obtains  the  decoupled,  linearized  relations 
by  exact  cancelation  of  terms.  It  is  also  clear  that  potential  for  relatively  simple  implemen¬ 
tation  using  accelerometers  may  offer  advantages  in  this  case  since  the  rrL  control  is  then 
insensitive  to  stiffness  and  damping  properties  of  the  elastic  appendage.  A  goal  of  the  FY89 
effort  will  be  to  investigate  the  potential  for  the  use  of  simplified  and  reliable  PFL  imple¬ 
mentation  using  low  cost,  solid  state  accelerometers  at  numerous  locations  on  the  structure. 
We  note  that  conclusive  results  in  this  area  can  be  obtained  only  after  a  dynamic  model 
of  the  accelerometer  is  included  in  the  analysis  and  control  design.  The  potential  for  such 
control  implementation  is  important  for  several  reasons  not  the  least  of  which  is  the  evolving 
technology  for  structural  components  with  embedded  solid  state  sensors  and  actuators  (e.g. 
using  piezoelectrics)  [De86j. 

6.4  Simulation  Results  for  Optical  LOS  Slewing 

The  above  PFL  decoupling  control  ( 6.20 )— ( 6.21)  was  simulated  for  the  ideal  case  with  the 
addition  of  the  steering  mirror  dynamics  as  given  in  (6.16 )— ( 6 . 19 ) .  The  resulting  response 
in  the  principal  body  LOS  9b  and  the  relative  (body  frame)  LOS,  A  los.  for  a  30  degree 
slew  are  shown  in  Figure  6.7.  The  required  linearizing  torques  77,  and  Tm  are  shown  in 
Figure  6.9-6.10.  The  ideal  commanded  acceleration  for  the  rigid  body  slew  «i  is  identical  to 
that  obtained  for  the  case  of  principal  body  slewing  since  the  slewing  controls  are  decoupled 
by  the  introduction  of  PFL  torques.  A  measure  of  appendage  deformation  resulting  from  the 
slew  can  be  obtained  by  examining  the  response  of  the  steering  mirror  9m  (see  Figure  6.8) 
and  the  deformation  at  the  end  of  the  appendage  (at  the  secondary  mirror)  i (see 
Figure  6.11).  In  this  framework  requirements  for  stiffness  and  damping  of  the  metering  truss 
can  be  determined  based  on  structural  limits  of  the  secondary  mirror  deflection  and  angular 
limits  of  the  steering  mirror  without  concern  for  effective  dynamic  pointing  precision. 

7  Survey  of  Methods  in  Robust  Nonlinear  Control 

7.1  Importance  of  Robust  Control  Design  for  Nonlinear  Slewing  Control 

Recently  considerable  research  effort  has  been  expended  in  developing  new  methods  for 
robust  control  system  design.  The  goal  of  these  methods  has  been  to  obtain  quantifiable 
limits  on  the  stability  and  performance  of  a  control  system  with  internal  dynamics  (of  both 
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the  plant  and  the  controller)  which  may  vary  in  specific,  quantifiable  ways  either  due  to 
changes  in  time  or  initial  model  imprecision.  The  importance  of  such  methods  can  not  be 
underestimated  in  practical  applications.  The  primary  emphasis  in  the  engineering  literature 
of  the  past  10  years  on  the  robust,  control  problem  is  the  use  of  linear  plant  models  and  linear 
control  law  dynamics. 

Early  results  of  Nyquist.  [Nyq32]  and  the  Bode  [Bod45]  provided  an  analytic  basis  for 
the  fundamental  engineering  tradeoff  between  dynamic  stability  and  a  scalar  loop-gain  pa¬ 
rameter  of  a  single  closed  loop  feedback  control.  In  the  early  1970’s  the  focus  of  research 
turned  to  the  robust,  stability  of  multiloop  feedback  control  utilizing  various  extensions  of 
Nyquist's  theorems  as  pioneered  by  Rosenbrock  [Ros74,  Ros72].  Recognizing  the  critical 
need  to  predict  stability  of  feedback  control  with  certain  nonlinear  effects  the  engineering 
community  developed  various  ways  to  bound  certain  nonlinear  effects  with  linear  systems 
and  obtain  (albeit  somewhat  conservative)  stability  results.  A  central  contribution  in  this 
area  is  the  work  of  Zames  [Zam63]  which  provides  the  basis  for  the  cornerstone  of  robust 
linear  control  theory  known  as  the  small  gam  theorem.  Using  this  theorem  results  can  be 
obtained  for  the  class  of  sector  bounded  nonlinearities  and  have  more  recently  been  extended 
to  multiloop  control  systems  by  using  singular  value  bounds  (i.e.,  L2  norm)  of  the  transfer 
function  (matrix)  frequency  response.  An  essential  feature  of  such  methods  for  design  is  that 
the  design  engineer  must  have  a  model  for  the  overall  nonlinear  system  where  the  nonlinear¬ 
ities  are  memoryless  and  sector  bounded  and  interact  with  a  model  of  the  system  (linear) 
dynamics  through  a  fixed  number  of  feedback  loops.  Thus  these  methods  support  design  of 
linear  control  systems  for  plants  which  may  contain  certain  isolated  nonlinear  effects.  In  this 
study  we  have  considered  a  more  direct  and  comprehensive  approach  to  nonlinear  control 
system  design  in  which  the  system  nonlinear  dynamics  are  utilized  to  effectively  ‘linearize’ 
certain  aspects  of  the  system  response. 

Our  main  interest  in  the  robust  control  problem  for  slewing  control  of  flexible  structures 
stems  from: 

1.  Concern  for  practical  application  of  advanced  nonlinear  control  system  design  methods 
including  both  EFL  and  PFL  for  the  class  of  models  considered  for  slewing  of  SBL  type 
systems.  Such  concerns  include: 

(a)  predicting  performance  limits  with  model  dynamics  based  on  imprecisely  known 
parameters 

(b)  predicting  performance  limits  with  reduced  order  model  dynamics, 

(c)  predicting  performance  in  the  presence  of  variation  of  system  dynamics  due  to 
environmental  changes  effecting  model  parameters, 

(d)  predicting  performance  in  the  presence  of  variation  of  system  dynamics  due  to 
parasitic  dynamics  unknown  at  design  time. 

2.  Concern  for  design  of  laboratory  experiments  to  demonstrate  advanced  nonlinear  con¬ 
trol  laws  for  rapid  slewing  control  of  flexible  structures.  Such  concerns  include: 

(a)  predicting  performance  with  modeling  imprecision  due  to  both  parasitic  dynamics 
and  parametric  variation, 
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(b)  assuring  stable  and  reliable  operation  of  experiments  including  stable  “tune  up” 
procedures  for  testing  high  performance,  high  gain  control  laws. 

In  this  section  we  will  briefly  review  some  available  results  in  robust  control  system  design 
for  nonlinear  systems  which  we  believe  will  be  important  tools  to  address  the  above  practical 
concerns.  It  is  important  to  emphasize  that  the  crucial  issue  in  robust  control  of  nonlinear 
slewing  of  flexible  structures  will  be  the  incorporation  of  concerns  for  the  parasitic  (high 
frequency)  dynamic  uncertainty  which  is  intrinsic  in  the  distributed  parameter  dynamics  of 
the  flexible  structure  and  the  nonlinear  (and  parametric)  uncertainty  due  to  the  dominance 
of  certain  nonlinear  effects  (such  as  Coriolis  and  gyroscopic  accelerations)  which  arise  because 
of  the  dynamic  requirements  of  rapid  slewing. 

7.1.1  Classification  of  Robust  Control  Results  and  Assumptions 

It  is  sometimes  useful  in  surveying  a  literature  as  diverse  as  robust  control  design  has  become 
to  at  tempt  to  classify  results  according  to  types  of  assumptions  placed  on  the  system  dynamic 
model.  The  diversity  available  reflects  an  intense  area  of  research  where — very  roughly  put — 
the  goal  is  to  obtain  the  least  conservative  characterization  of  conditions  for  robust  stability 
and  performance  with  the  least  restrictive  assumptions  on  the  plant  dynamics.  Thus  we  can 
classify  available  results  according  to  assumptions  on  model  uncertainty  as: 

•  parametric  versus  nonparametric  (or  parsitic), 

•  structured  versus  nonstructured. 

Structured  vs.  Nonstructured  Uncertainty.  We  indicate  model  uncertainty  as  struc- 
t n rot  if  the  uncertainty  is  characterized  as  being  localized  in  the  system  dynamics  (i.e.,  it 
effects  a  structured  portion  of  the  system  model  only)  and  unstructured  otherwise. 

Parametric  versus  nonparametric  uncertainties.  Parmetric  models  for  dynamic  un¬ 
certainly  include  cases  where  both  physical  and  artifical  model  parameters  are  allowed  to 
vary  over  specific  sets.  Such  plant  model  variation  does  not  incorporate  changes  in  model 
order  in  a  natural  way.  Nonparametric  (or  parasitic)  model  uncertainty  attempts  to  char¬ 
acterize  model  variation  which  can  incorporate  changes  in  the  effective  dynamic  degrees  of 
freedom.  We  remark  that  the  methods  of  singular  perturbation  analysis  decribed  for  example 
in  Kokotovic  [Kok8-5]  attempt  to  reconcile  these  two  views  of  model  uncertainty.  As  such  we 
expect  these  method  to  play  an  important  role  in  robust  control  of  rapid  slewing  of  flexible 
structures.  (See  Appendix  C  for  preliminary  results  on  application  of  these  ideas  to  design 
of  control  for  a  flexible  multibody  system.) 

7.2  Robust  Stability  of  Linear  Systems 

By  way  of  introduction,  motivation,  and  comparison  with  available  methods  for  nonlinear 
systems,  we  briefly  review  the  general  results  for  robust  stabilization  of  linear  systems. 

The  two  common  linear  multivariable  plant  models  used  in  literature  are: 
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•  State-variable  models  generally  written  in  the  form: 

x  =  Ax  +  Bu,  y  —  Cx  -f  Du 


•  Transfer-function  matrix  models  denoted  (7(s)  where  G(s)  is  a  px  q  matrix  with  entries 
made  up  of  rational  functions  in  the  complex  Laplace  transform  variable  s. 

Each  one  of  these  plant  models  requires  its  own  type  of  uncertainty  model.  Some  of  these 
uncertainties  for  state- variable  models  can  be  modelled  as  follows: 

Parametric  unstructured:  Let  Ax  —  (.4-f  5A)x.  where  6.4  is  constrained  only  in  norm, 
i.e,  ||  6.4  || <  a. 

Parametric  structured:  Two  examples  of  model  uncertain  assumptions  in  this  category 
are: 

1.  .4.r  —  (A  +  T,  qiAi)x ,  —  1  <  q,<  1  where  the  parametric  uncertainty,  represented  by 
7,,  is  structured  by  virtue  of  the  structure  of  the  .4,. 

2.  Refering  the  linear  state  space  model  above  (.4,  B)  (.4  4-  6.4(7),  &  +  65(g))  where  7 
is  assumed  to  belong  to  a  known  compact  set.  We  say  6.4  and  SB  satisfy  the  structure 
matching  conditions  if: 

6.4  =  BD,  SB  =  BE.  (7.1) 

For  robust  stability  of  linear  systems  it  is  often  more  useful  to  characterize  model  uncer¬ 
tainty  in  terms  of  the  frequency  response  or  transfer  function  model.  Uncertainty  in  G  has 
been  characterized  as: 

Multiplicative  unstructured  nonparametric;  e.g.,  G  —  (/  +  L)G  or  G(I  +  L )  where 
||L(;?i')||  <  Im(u’).  Here,  ||L||  denotes  the  norm  of  the  matrix  L. 

Additive  unstructured  nonparametric;  e.g.,  G  —>  SG,  where  ||6(7||  <  la{w). 

Additive/multiplicative  structured  nonparametric;  same  as  above  but  only  certain 
elements  of  L  and  SG  are  variable. 

We  remark  that  using  transfer  function  models  for  uncertainty  one  can  readily  charac¬ 
terize  parasitic  dynamic  uncertainty.  This  is  a  central  reason  for  the  popularity  of  frequency 
response  methods  for  control  system  design.  Recently  the  development  of  control  design 
methods  based  on  worst,  case  optimization  in  the  Hardy  space  H°°  of  transfer  functions  has 
provided  a  formal  design  approach  for  linear  systems  based  on  a  well  defined  optimization 
criterion  which  embodies  robustness  [Zam81j. 

The  vast  literature  on  optimal  robust  control  design  is  outside  the  scope  of  the  present 
study.  It  significance  for  EFL  and  PFL  is  a  subject  which  we  will  study  in  more  detail  in 
the  next.  year.  For  now  we  confine  our  comments  to  its  potential  for  addressing  the  robust 
stabilization  of  the  effective  linearized  system  obtained  from  the  nonlinear  EFL  (or  PFL) 
compensator  (cf.  [Spo86]). 
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7.2.1  A  State  Space  Approach  for  Linear  Systems 

An  important,  approach  to  robust  control  system  design  was  obtained  by  Barmish,  C'orless, 
and  Leitmann  [BCL83].  They  use  Lyapunov-function  theory  to  design  robustly  stable  con¬ 
trollers  for  linear  systems.  The  main  advantage  of  their  method  is  that,  as  we  will  see  later,  it 
can  easily  be  generalized  to  nonlinear  systems.  The  authors  show  that  if  the  plant  dynamics 
are  given  by: 

x  =  (A  +  AA)x  +  (B  +  AB)u  (7.2) 

and  the  matching  conditions : 

A  A  =  BD,  A  B  =  BE  (7.3) 

hold  for  the  plant  uncertainty,  with  ||  D  ||<  po  and  ||  E  ||<  1.  then  the  state  feedback 
v  =  — 2')o BT Px  will  always  robustly  stabilize  System  (7.2).  provided  that,  the  positive  scalar 
In  is  chosen  sufficiently  large.  The  matrix  P  in  the  state-feedback  control  law  is  given  as  a 
solution  of  the  Lyapunov  matrix  equation,  ArP+  PA  =  —  H ,  where  H  is  any  positive  definite 
matrix.  The  matching  conditions  (7.2)  do  impose  a  special  structure  on  the  permissible 
plant  variations.  Patel  et  al  [PTS77],  and  Yedavalli  [Yed85]  also  exploit  Lyapunov  function 
theory  to  obtain  conditions  on  the  A  matrix  in  the  state- variable  plant  description  for  robust 
stabilization. 

7.3  Robust  Stabilization  of  Nonlinear  Systems. 

Recent  developments  in  feedback  design  of  nonlinear  systems  fall  into  two  categories.  Results 
which  are  geometric  in  nature  are  essentially  independent  of  a  coordinate  system  for  the  state 
space  and  view  the  system  as  a  collection  of  vector  fields  evolving  on  a  manifold  which  can 
be  embedded  in  a  larger  Euclidean  space.  A  second  body  of  results  are  asymptotic  in  nature 
and  use  Lyapunov  and/or  singular  perturbation  techniques. 

7.3.1  Geometric  methods  in  nonlinear  control. 

The  inital  emphasis  in  the  development  of  geometrical  methods  for  nonlinear  control  was  to 
extend  the  well  knowm  linear  theory  of  Wonham  [Won74]  to  linear  systems  which  are  affine 
in  the  control  variable.  The  methods  of  EFL  and  PFL  described  in  this  report  are  examples 
of  this  line  of  development. 

Unfortunately,  these  geometric  techniques  present,  some  limitations  from  the  engineering 
point,  of  view.  One  such  limitation  is  that  results  of  a  geometric  nat  ure  are  sometimes  difficult 
to  apply  in  practice  because  highly  accurate  models  must  be  available  in  order  to  verify  that, 
certain  exact,  conditions  of  the  theory  are  satisfied.  Moreover,  since  the  construction  of  the 
linearizing  feedback  involves  “cancellation”  of  certain  nonlinearities,  it  leaves  open  many 
questions  regarding  sensitivity  and  robustness  of  the  control  implementation.  One  approach 
which  has  been  pursued  by  several  researchers  is  to  use  the  available  freedom  in  the  linear 
controller  design  (once  effective  linearization  has  been  achieved  for  a  nominal  model)  to 
recover  stability  robustness  (MC80,  GMS82], 

It  is  interesting  to  note  the  interpretation  given  by  Meyer  [ M e y 8 1 )  to  EFL  and  its  relation 
to  a  trajectory-dependent.  Taylor  series  expansion  of  the  nonlinear  vector  fields.  Consider  a 


SEI-88-10-15-WB 


43 


nonlinear  system  given  by, 

•r(<)  =  f(x)  +  g{x)u. 

To  obtain  EFL  control  we  seek  transformation  of  the  state  and  feedback  so  that  the  effective 
system  is  in  a  linear  canonical  form. 


V  i  =  J/2 1 


2 )n  -  V. 

where  the  transformation  is  effected  by  the  maps  T(x,u)  -  y  and  W(y,i>)  -  u  which 

effectively  invert  the  transformation  to  linearized  coordinates.  If  we  consider  a  Taylor  series 
expansion  of  the  nonlinear  system  in  the  neighborhood  of  a  given  state  trajectory  x(t) — which 
we  assume  is  valid  pointwise  on  x(t) — we  obtain  a  linearized  model  of  the  form 

x  =  (a0  +  art)  +  Ax  +  Bu, 

where  a0. uj.  .4,  B  are  constant  (at  least  locally).  Under  these  assumptions  Meyer  suggests 
that  the  effective  T  and  \V  maps  can  be  interpreted  as  (linear)  transformations  of  the  local 
nonhomogeneous  linear  model  just  obtained  to  the  canonical  form  via 

y  =  Tx  T  c0  +  cit, 


and 

u  =  W v  4-  Ry  4-  60  -f  b^t. 

The  matrices  T.  W,  R  depend  on  the  homogeneous  part  (A,B)  of  the  local  linearized  model. 
However,  the  introduction  of  nonhomegeous  part  in  the  effective  linear  system  is  nonstandard 
and  results  on  robust  linear  control  must  be  carefully  reevaluated  in  this  context. 

7.3.2  Asymptotic  methods 

The  second  body  of  results  consists  of  mainly  Lyapunov-based  techniques  to  design  robustly 
stable  controllers  for  the  nonlinear  system.  Roughly  speaking,  a  nonlinear  system  x  =  f(x) 
is  asymptotically  stable  if  there  exists  a  function  (Lyapunov  function)  V'(.t)  which  is  positive 
for  all  non-zero  x  and  which  has  a  time-derivative  V(.r)  which  is  negative  for  all  non-zero  x. 
Obviously,  if  the  inequalities  in  question  are  true  for  all  admissible  variations  in  f{x),  the 
Lyapunov  stability  theory  also  provides  conditions  for  robust  stabilization.  An  early  paper 
on  the  application  of  Lyapunov  function  to  robust  stabilizaton  is  the  paper  of  Gutman  and 
Lehman  [ 0 L 7 6 ] .  The  monograph  of  Safonov  [SafSOj  also  contains  an  extensive  discussion  of 
the  application  of  Lyapunov  functions  to  robust  stabilization. 

In  contrast  to  geometric  methods,  asymptotic  methods  do  not  rely  on  transforming  the 
system  into  a  more  convenient  canonical  form;  rather,  they  consider  uncertainty  as  a  class 
of  bounded  perturbations  to  the  state  model.  The  methods  often  employ  effective  high- 
gain  feedback  to  combat  uncertainty  and  exogenous  disturbances.  Among  such  methods  are 
the  so-called  Variable  Strucure  Control  (VSC)  methods  which  were  discussed  in  the  previous 
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report  [BBK88]  and  the  controller  structures  proposed  by  C'orless  and  Leitmann  [CL81]  which 
generalizes  the  design  for  linear  systems  described  previously.  The  C'orless-Leitmann  robust 
controller  guarantees  a  form  of  stabilty  called  uniform  ultimate  boundedness  of  the  state  to 
an  arbitrarily  small  neighborhood  of  the  origin;  and  might  be  termed  practical  stability.  The 
type  of  uncertainty  models  they  consider  contain  mainly  parametric  structured  uncertainties 
satisfying  a  generalized  version  of  the  matching  conditions  (7.2).  The  need  for  these  matching 
conditions  represents  one  of  the  main  restrictions  of  robust  control  methodologies,  for  both 
the  linear  and  nonlinear  case.  In  the  next  year  we  will  examine  the  application  of  these 
assumptions  for  the  class  of  nonlinear  models  described  in  this  report  and  investigate  the 
meaning  of  the  matching  conditions  for  slewing  of  flexible  structures. 

7.3.3  Parametric  structured  uncertainties 

Geometric  methods.  The  main  geometric  results  in  the  literature  on  the  robust  stabi¬ 
lization  of  nonlinear  systems  with  structured  uncertainties  involve  two  assumptions  which 
may  restrict  application.  The  first  is  that  the  results  are  restricted  to  the  class  of  feedback 
linearizable  systems;  i.e..  systems  which  are  exactly  linearizable  (using  EFL)  or  minimum- 
phase  systems  (using  PFL).  The  second  restriction  is  that,  the  uncertainties  which  account,  for 
the  difference  between  the  true  plant  and  the  simplified  given  model,  are  assumed  to  satisfy 
the  structure  matching  conditions.  The  basic  design  paradigm  is  that  once  the  linearizing 
change  of  coordinates  and  feedback  is  applied  to  the  uncertain  nonlinear  model,  a  perturbed 
linear  model  is  obtained.  The  key  point  is  that  the  uncertainties  on  the  linear  model  will 
retain  the  same  nice  structure  of  the  uncertainties  (via  matching  conditions)  on  the  nonlin¬ 
ear  model.  The  available  freedom  in  the  linear  system  design  phase  can  then  be  used  (as 
suggested  by  Meyer  [GMS82]  and)  as  discussed  in  the  previous  sections.  Spong  [Spo86]  and 
Kravaris  [Kra87]  follow  this  same  approach  and  use  a  similar  type  of  controller.  Kravaris’s 
result  is  less  restrictive  since  he  assumes  only  that  the  system  is  minimum  phase  and  applies 
PFL  rather  than  EFL.  (As  we  have  suggested  throughout  this  study  PFL  is  an  essential 
practical  feature  of  the  control  problem  for  rapid  slewing  of  flexible  structures.) 

For  simplicity  of  presentation  we  describe  Spong’s  approach.  The  true  plant  is  assumed 
to  be  of  the  form: 


i  ~  f(x)  +  S"13i(.T)u,(f) 

=  f(x)  +  G(t)u 

with  the  usual  smoothness  assumptions  on  / .  gi, .  . . ,  gm  on  Rn  and  /( 0)  =  0. 


(7.4) 


Assumption  1:  There  exists  a  diffeomorphism  T(x)  on  Rn  and  nonlinear  smooth  functions 
a ( x ) ,  id ( x )  of  appropriate  dimensions,  with  /3(x)  invertible,  such  that  with  the  change  of 
coordinates  c  =  T{x)  and  nonlinear  feedback  u  =  a(r)  -I-  f3(x)v,  the  plant  (3)  becomes: 

:  =  A:  +  Bv  ( 7.5) 

with  (.4.  B )  in  Brunovsky  canonical  form.  The  design  model  is: 


x  =  f(x)  4  G[x)u 


(7.6) 
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where  /,  G  are  nominal  versions  of  /,  G  respectively. 

Assumption  2  :  Let 

^/(•r)  =  /(* )  -  hx) 

A  G(x)  =  G(x)-G(x) 

denote  the  mismatch  between  the  plant  and  the  model.  We  assume  there  exist  smooth 
functions  D(x),  E(x)  on  Rn  such  that  the  following  matching  conditions  are  satisfied: 

A  f{x)  =  G(x)D{x ), 

A  G(x)  =  G(x)E(x). 

Assumption  2  combined  with  Assumption  1  implies  that  the  model  (7.5)  is  also  feedback 
linearizable  with  the  same  change  of  coordinates  T(x)  used  for  the  original  plant  and  a 
nonlinear  feedback  u  =  a(x)  +  f3(x)v  to  the  same  canonical  linear  system  (7.5).  An  example 
t  hat  satisfies  these  constraints  can  be  found  in  mechanics.  Two  rigid  robot  manipulators  are 
in  the  same  orbit  under  the  action  of  feedback,  that  is  they  can  both  be  linearized  using  the 
same  change  of  coordinates  z  =  T(x)  and  different  feedbacks  provided  that  they  have  the 
same  number  of  joints  and  powered  and  unpowered  joints  of  the  manipulators  coincide. 

If  we  apply  the  linearizing  change  of  coordinates  z  =  T(x)  and  the  nonlinear  feedback 
v  —  a(,r )  ■Jrf3(x)v  to  the  true  plant  (7.5),  we  obtain  a  perturbed  linear  system  with  structured 
uncertainties: 

z  =  Az  +  B{  v  +  tj(z,v)}  (7.7) 

where 

Tj{z,v)  =  /5(x)-1{£>(.r)  +  £(;r)(d(x)  +  4(*h’)U=r-'(s)}. 

=  <f>(z)  +  4>(z)v. 

The  following  additional  assumptions  are  made  on  the  nonlinearity  rj(z,v); 
Assumption  3:  There  exists  a  positive  constant  a  <  1  such  that  for  c  £  Rn: 

II  V’(-)  ||<a 


Assumption  4:  There  exist  positive  constants  a  and  b  such  that  for  z  £  Rn: 

II  tf=)||<«  +  MMI 
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Design  of  the  e-controller.  Several  robust,  controllers  can  now  be  introduced: 

(i)  The  first  controller  proposed  is  a  linear  dynamic  compensator  e(s)  —  C'(s)r(s).  The 
multi-loop  version  of  the  small  gain  theorem  [DV75]  shows  that  the  control  signal  v(t) 
and  the  “uncertainty’’  77  are  bounded  in  L provided  C(s)  is  designed  in  such  a  way  as 
to  satisfy  the  modelling  assumptions  (3)  and  (4)  and  the  stability  condition  provided 
by  the  small  gain  theorem.  To  design  such  a  compensator  C'(s),  the  stable  factorization 
approach  which  was  developed  during  recent  years  by  various  researchers  and  given  a 
exposition  in  [Vid85],  is  used. 


(ii)  The  second  approach  for  design  focuses  on  practical  stability.  One  designs  a  control  law 
for  v  that  guarantees  the  uniform  ultimate  boundedness  of  the  state  z(t)  to  an  arbi¬ 
trarily  small  neighborhood  of  the  origin.  Two  state  feedback  schemes  can  be  designed 
using  this  approach  to  guarantee  stability  of  the  uncertain  linear  system  (7.6)  within 
the  modelling  assumptions  (7.5)  and  (7.5).  The  first  one  is  a  saturating  nonlinear 
controller  and  the  other  one  is  a  high  gain  linear  controller.  The  design  methodology 
is  based  on  the  second  method  of  Lyapunov. 

The  controller  v  is  taken  as  v  =  K z  +  At-  where  K  is  chosen  so  that  A  +  BK  is  Hurwitz. 
The  uncertain  linear  system  (7.6)  becomes  then: 

z  =  (A  +  BI<)z  +  B{Av  +  v(z,Av)}  (7.8) 


One  way  to  design  Av  is  (following  the  work  of  Leitmann  [Lei81])  to  choose  Av  as  a  saturating 
nonlinear  quantity: 


At- 


-rt'-.OsiJfiir  if  HflrF-ll>e 

BT P z\  if  II  BTPz  ||<  c 


(7.9) 


for  some  (given)  e  >  0,  p  satisfying, 


IMI  <  P(  =  A),  (7.10) 

||  At- ||  <  p(z,t),  (7.11) 


and  P,  the  unique  positive  definite  solution  to  the  Lyapunov  equation; 

(.4  +  BK)tP  +  P(A  +  BK)  +  Q  =  0. 

The  idea  is  that  the  function  T(r)  =  zTPz  (which  is  a  Lyapunov  function  for  the  linear 
system  (.4  +  BK,  B))  is  a  Lyapunov  function  for  the  nonlinear  system  (7.7)  provided  that. 
7/  satisfies  (7.9).  The  uniform  ultimate  boundedness  set  can  then  be  made  arbitrarily  small 
by  decreasing  e.  For  e  —  0,  the  system  is  asymptotically  stable  and  the  control  law  (8)  is 
discontinuous. 

Another  way  to  design  Av  follows  from  the  work  of  Thorp,  Barmish  [TB81]  and  others 
on  robust  linear  control.  Here  we  take  Ac  as  a  strictly  linear,  but.  high  gain  control  law; 

A  v(t)  =  —~fBTPz, 


where  7  >  0  is  sufficiently  large  so  that  the  state  z{t)  is  uniformly  ultumately  bounded.  The 
calculation  of  7  and  the  ultimate  boundedness  set  can  be  found  in  [ T B 8 1  ] . 
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Lyapunov-based  methods:  As  mentioned  earlier,  most  of  the  results  that  use  Lyapun¬ 
ov-based  techniques  to  design  robustly  stable  controllers  for  nonlinear  systems  use  either 
explicitely  or  implicitely  high  gain  feedback  to  combat  uncertainties.  One  of  the  interesting 
results  on  robust  stabilization  of  nonlinear  systems  with  parametric  structured  uncertainties 
is  the  controller  proposed  by  C'orless  and  Leitmann  (as  a  generalization  of  their  earlier  linear 
control  methods).  The  stability  concept  used  is  termed  “practical  stability”  and  differs 
slightly  from  the  traditional  Lyapunov  stability.  Normally  Lyapunov  arguements  are  used 
in  design  to  guarantee  uniform  asymptotic  stability  of  an  equilibrium  state.  However,  in 
practice  one  is  often  content  with  uniform  ultimate  boundedness  to  some  set  in  finite  time. 
The  uncertain  dynamical  system  is  assumed  to  be  described  by  the  state  equation, 

x  =  f(x(t),t)  +  A f(x(t),t)  +  [B(x(t),  t)  +  A5(r(t),t)]ti(f) 

where  x(t)  <E  Rn  is  the  state,  u(t)  €  Rm  is  the  control,  and  f{x>t),Af(x,t),B(xJ)  and 
A  B(x,t)  are  matrices  of  appropriate  dimensions  which  depend  on  the  structure  of  the  system. 
Additional  conditions  may  be  imposed  on  how  A /  and  A B  structurally  enter  the  state 
equations. 

Assumption  1:  A /  and  A B  satisfy  the  structure  matching  conditions;  i.e. ,  there  are 
mappings 

h(.)  :  Rn  x  R  -  Rm  and  E(.)  :  Rn  x  R  -  iT”<m 

such  that 


A/(.t,  t)  =  B(x ,t)h(x,t) 

AB(x,t)  =  B(x,t.)E{x,t)  (7.12) 


for  all  x  <E  Rn  and  t  £  R. 

Because  of  this  assumption,  all  uncertain  elements  can  be  “lumped”  and  the  system  is 
written, 

x(t)  =  f{x(t),t)  +  B{x{t),t)u{t)  +  B{x(t),t)e(x{t),t).  (7.13) 

The  “nominal”  system,  that  is,  the  system  without  uncertainty,  is  described  by 

X  =  f{x(t),t.)  +  B{x(t),t)u{t). 

Based  only  on  the  knowledge  of  the  maximum  possible  value  (which  may  depend  on  x  and 
t )  of  the  norm  ||  e(x,t)  ||,  the  aim  is  to  find  a  feedback  control  u(.)  :  Rn  x  R  — *  Rm  such  that 
given  (.To,  to).  a  corresponding  response  x(.)  :  [fo.cso)  — »  Rn  exists,  and  every  such  response 
enters  a  neighborhood  of  x  =  0  in  finite  time  and  remains  within  it  thereafter.  This  is 
uniform,  ultimate  boundedness.  The  following  additional  conditions  are  also  assumed: 

Assumption  2:  The  known  functions  /,  B  as  well  as  the  unknown  function  e  are  contin¬ 
uous  functions,  and  /(0,£)  =  0  for  all  t  6  R. 


Assumption  3:  The  norm  of  the  uncertain  element  is  bounded  by  a  known  function;  that 
is.  for  all  ( ,r ,  < )  £  Rn  x  R 

II  e{x,t)  || <  p(x,  t) 

where  the  known  function  p  is  a  continuous  function. 

Assumption  4:  Given  a  compact  set  E  C  Rn  and  a  compact  interval  [a,  6]  C  R ,  there 
exist  continuous  functions  m,(.)  :  [a,  b]  —  /?,  i  —  1,2,  such  that  for  all  (z,t)  €  E  x  [a,  6] 

11/(2-, Oil  <  mi(t), 

II  B{x,t)  ||  p{x,t)  <  m2(t). 

Asstunption  5:  The  origin,  x  =  0  is  uniformly  asymptotically  stable  for  the  uncontrolled 
nominal  system  x  =  f(x(t),t).  In  particular,  there  are  a  C1  function  (Lyapunov  function) 
l’(  ):  R”  x  R  —  R+  and  continuous,  strictly  increasing  functions  7 ,■(.)  :  R+  — +  R+ ,  i  =  1,2,3 
which  satisfy 

7;(0)  =  0,  t  =  1.2.3 
lim  7,(r)  =  00.  i  =  1,2 

r—oo 

such  that  for  all  (  .t ,  < )  £  Rn  x.  R 

7i( II  2:  ||)  <  V'(x,t)  <  72(||  ,t  II) 

^  +  ^Vr(2-,t)/(.r,0  <  -73(||  t  ||). 

In  [CL81],  a  class  of  state  feedback  controls  is  proposed.  A  member  of  this  class,  u(.)  : 
R”  *  R  —  RE ,  is  a  continuous  function  such  that,  for  given  e  >  0, 

«(M)  =  -  -  ||  p(x,t)  ||>  c,  (7.14) 

II  II 

||  «(.x, « )  ||  <  p{, r,t),  if  ||  p(x,t)  || <  e,  (7.15) 

where 

p(x.t)  =  BT{x,t.)VIV(x,t)p(x,t). 

A  particular  example  of  such  a  control  is 

K(xt)  =  {  if  it ii>, 

*  ’  1  if  II  «<*.«)  ||<<  ' 

It  is  shown  in  [CL81]  that  a  control  of  the  type  ( 7.14)— (7.15)  guarantees  ultimate  boundedness 
of  all  possible  system  responses  within  an  arbitrarily  small  neighborhood  of  the  zero  state 
(by  letting  t  —  0).  Furthermore,  the  set  of  ultimate  boundedness  as  well  as  an  upper  bound 
on  the  time  interval  required  to  reach  it  are  given  explicitely  in  terms  of  the  functions  7, 
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defined  above.  More  specifically,  it  is  shown  that,  a  solution  x(.)  :  — 4  Rn,x(t0)  =  x0, 

of  the  closed  loop  system: 

x(t)  -  f(x(t),t)  +  B{x(t).t){u(x{t),t)  +  e(x(f),f)] 

with  u{x(t),t)  satisfying  (7.14 )— ( 7.15),  exists  and  satisfies 


II  J’o  ||<  r  =-||  x(f)  ||<  d(r).  V#  £  [<0,  t  j] 


where 


and 


d(r) 


ill  1  o  l2)(R)  if  r  <  R 
(7J-1  °  72)(r )  if  r  >  R 


R  =  l3_1(2f)- 


Furthermore,  the  solution  has  a  continuation  over  [f0,oo)  and  for  ]|  Xo  ||<  r  and  given 

d  >  (7i-1  o  72  )(R) 

||  x(<)  ||<  <7,  Vt  >  t0  +  T(d.r) 


where 

(  0  if  r  <  R 

mr)=  1  "rrripi? 

and 

R  =  (l2l  0  Trt  )(<?)- 


7.3.4  Nonparametric  nonstructured  uncertainties: 

In  the  case  of  unstructured  but  “not  too  large"  nonlinear  model/plant.  mismatch,  Kravar- 
is  [Kra87]  follows  exactly  the  same  principle  as  described  previously;  i.e.,  use  feedback  to 
make  the  system  linear  then  put  a  robust  linear  controller  around  it  to  stabilize  the  overall 
system.  The  interesting  point  in  this  procedure  is  the  fact  that  Kravaris  evaluates  the 
unstructured  uncertainty  in  such  a  way  that  it  is  possible  to  apply  frequency-domain  results 
from  linear  robust  control  literature.  More  precisely,  and  since  only  partial  linearization  is 
used,  the  approach  taken  is  the  following: 

(i)  Make  the  input/output  response  of  the  system  linear  by  appropriate  input-output,  lin¬ 

earizing  state  feedback. 

(ii)  Evaluate  the  uncertainty  as  a  multiplicative  band  of  the  resulting  input-output  system. 

(iii)  Design  an  external  robust  linear  regulator  on  the  basis  of  linear  theory. 

Step  (i):  Input/Output  linearizing  state  feedback:  Consider  the  nonlinear  system: 

x  -  f(x)  +  g(x)u 

y  =  h(x)  (7.16) 
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where  x  (E  /?",«€  R,  y  €  R-  The  problem  of  finding  a  static  state  feedback  of  the  form 
it  —  U'(x ,  i>)  such  that  the  v  >— *•  y  input/output.  is  linear  and  of  minimal  order  was  posed  and 
resolved  in  { I s i 8 5 ] .  The  results  are: 

The  minimal  order  of  the  v  >—  y  system  is  the  relative  degree  of  (7.16),  i.e. ,  the  smallest 
integer  r  satisfyng: 

{dh.adTfxg)  ±  0. 

The  input/output  linearizing  state  feedback  is  given  by: 


u  = 


V  -  ^k=of3kLkf(h) 


(7.17; 


(-1  )r-xj3r{dh,adTf  x{g)) 

where  3^  are  arbitrarily  selected  numbers.  The  corresponding  closed-loop  response  is  given 
by: 

d^y 


Assumption  1:  Assume  that  the  nonlinear  system  (7.16)  is  minimum  phase,  that  is  the 
( n  -  r)  unobservable  or  zero  dynamics  are  stable. 

Step  (ii):  Structure  of  the  uncertainty:  The  way  Kravaris  evaluates  the  uncertainty  is  by 
assuming  that  the  plant/model  mismatch  can  be  expressed  as  a  Volterra  operator  applied 
to  the  model.  That  is,  if  we  consider  the  family  II  of  nonlinear  systems  y  =  M(u )  (not 
necessarily  of  the  same  order),  then: 

1.  For  all  plants  M  in  II,  there  exists  a  Volterra  operator  of  the  form: 

A  m  (  •  )  =  L(t  -  r  ).(t  )dr 

such  that: 

M{u)  —  M(u)  =  A  mM(u),  Vm 

where  AI(u )  represents  the  input/output  map  of  the  model  (7.16). 

2.  An  upper  bound  l{ w)  of  lm  is  available  such  that 

lm(iu)  <  l( u;),  Vw 

where  the  overbar  denotes  the  Laplace  transform. 

Step  (iii):  Robust  linear  control  design  for  linearized  dynamics:  Once  again,  results 
from  the  robust  linear  control  literature  are  used.  Since  Kravaris  is  using  frequency 
domain  bounds  on  the  uncertainty,  he  applies  standard  linear  system  results  for  robust 
control  [DS81],  For  the  family  of  plants  II,  if  we  take  the  nonlinear  state  feedback  (7.17), 
and  the  external  feedback  controller: 

v{s)  =  C(s)[y,p{s)  -  y{s)\ 

and  we  assume  that  the  closed-loop  system  corresponding  to  the  model  M  is  stable, 
then  the  closed  loop  system  will  be  stable  for  all  plants  in  II  if: 

C(iu>)  _  1 

Ek=M*v)k  +  nM  <r 
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7.3.5  Parasitic/Unmodelled  dynamics: 

In  [TKM88]  Kokotovic  and  Marino  attempt  to  unify  geometric  and  asymptotic  method¬ 
ologies.  While  geometric  conditions  such  as  conditions  for  feedback  linearization  are 
restrictive  but  exact,  asymptotic  time-scale  results  are  less  restrictive  but  approximate. 
A  geometric  characterization  of  asymptotic  time-scale  properties  is  the  existence  of  an 
invariant  manifold  in  which  the  system  is  described  by  a  reduced  order  model  (Marino 
and  Kokotovic  [MK88]).  One  possibile  way  to  relax  the  feedback  linearization  con¬ 
ditions  can  be  obtained  by  requiring  that  they  be  satisfied  only  for  a  reduced  order 
model.  This  idea  has  been  suggested  by  Kokotovic  [Kok85j  and  developed  for  a  flexible 
robotic  manipulator  in  Spong  et  al  [SKK87].  It  is  shown  that  the  nonlinear  controller 
preserves  the  regulation  property  in  a  prescribed  stability  region  in  the  presence  of 
unmodelled  dynamics.  The  size  of  the  region  can  be  estimated. 

In  most  applications,  the  design  model  is  of  lower  order  than  the  plant  because  of 
some  unmodelled  dynamics  present  in  the  plant.  Following  [TKM88]  we  assume  the 
singularly  perturbed  model  of  the  plant  can  be  obtained  in  the  form, 

x  =  /i(x)  -I-  Fi(x)z  4-  i  ?  i?n,«  £  l?m,  (7.18) 

//i  =  /2(x)  +  F,(x):  +  G2{x)u.  zeR\  (7.19) 

where  the  functions  /i.  /2,  F\,  F2,  G'i.  G'2  are  bounded  and  differentiable  with  respect 

to  x  for  all  x  £  Bx  (a  ‘ball’  in  Rn),  (x,  r)  =  0  is  an  equilibrium  point,  and  /t  >  0  is  the 

singular  perturbation  parameter,  z  is  the  state  of  the  unmodelled  dynamics. 

Assumption  1:  The  unmodelled  dynamics  ;  are  asymptotically  stable  for  all  fixed 
values  of  x  £  Bx ,  that  is,  there  exists  a  constant  a  >  0  such  that: 

ReA{F2(x)}  <  —<7  <  0. 


Remark:  We  note  that  the  stability  assumption  of  the  unmodeled  or  residual  dynam¬ 
ics  is  a  natural  one  for  structural  control  since  we  will  utlitmately  rely  on  the  natural 
damping  of  the  structure  to  stabilize  its  (possibly  very)  high  frequency  dynamics. 

The  assumption  //  <C  1  implies  that  the  unmodelled  dynamics  are  “fast”  relative  to 
the  dynamics  of  x.  A  reduced  order  model  can  be  obtained  by  taking  /<  — 1 ►  0  which 
obtains  the  model, 

x  =  /( x )  +  G(x)u 

where  /  and  G  are  defined  by: 

/(*)  =  /l(x)  -  F,(x)F2-1(x)/2(x). 

G(x)  =  GA-r)-  Fl(x)F2-\x)G2(r). 


(7.20) 
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Assumption  2:  Vx  €  Bx ,  the  reduced  order  model  (7.20)  is  feedback  linearizable, 
that  is.  there  exists  a  state  diffeomorphism  x  =  $(.t)  and  a  state  feedback  control 
if  =  a(  x )  such  that,  given  an  n  x  n  Hurwitz  matrix  A,  the  identity: 

X  ) 

dx  lf(x)  +  g(''c)q(:c)]  =  >**(*) 

holds  for  all  .r  £  Bx.  If  <1>  and  a  are  applied  to  the  full  order  system  (7.18 )— ( 7.19),  and 
the  new  fast  variable  i)  =  c  —  h(x)  is  introduced  where  h(x)  is  the  so-called  “manifold 
function" ' 

h(x)  =  -Fpl{x)[f2(x)  +  G2(x)a(i)j, 

♦  hen  the  full  order  system  becomes. 


■r  =  $x  1A$(a;)  +  FAx)?],  (7.21) 

fir]  =  F2{x)i]  -  n  'h.  (7.22) 

Stability  analysis:  Let  P,  and  P/(x)  be  defined  as  the  symmetric  positive  definite 
solutions  of, 

P,A  +  AT  P,  = 

Pf(x)F2(x)+  F?(x)P,(x)  =  -Ir. 

Then  the  Lyapunov  function  to  be  employed  is, 

V(.r,7?)  =  c1$T{x)P,${x)  +  c2t]T  Pf{x)Ti.  (7.23) 

This  function  is  a  weighted  sum  of  a  slow  part  characterizing  the  stability  properties 
in  the  manifold  rj  =  0,  and  a  fast  part  characterzing  the  off-manifold  behavior. 

If  the  bounds  and  cj  are  evaluated  over  x  E  Bx  as, 

2  ii  pm  ii  *;  <  ci 

2||Pf$I(z)F1(r)||  <  c2, 

2  ||  Pf(x)  ||  k;+  ||  Pf(x)  ||  <  c-, 

where  the  constants  k{  and  k j  are  determined  from  the  requirement  that  for  all  x  £  Bx\ 

hm*)*;1(*mii  <  ki 

||  hx(x)Fi(x)  ||  <  kl 


then  using  the  Lyapunov  function  (7.23),  the  following  stability  result  is  obtained: 
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Result:  The  equilibrium  .r  =  0,  7  =  0  of  the  feedback  system  (7.18 )— ( 7.19)  is  asymp¬ 
totically  stable  for  all: 

M  €  (0,  .  *  .)  ( 7.24) 

ClC2  +  ^3 

and  an  estimate  of  its  region  of  attraction  is: 

SD  =  {x,T]  :  V(x,tj)  <  c“} 

where  c'is  the  largest  constant  such  that  the  set  (3-  :  F(.r,0)  <  c'}  belongs  to  This 
result  describes  a  robustness  property  with  respect  to  dynamic  uncertainty.  It  states 
that  the  stability  properties  of  the  reduced  order  design  are  preserved,  at  least  in  5/?, 
for  unmodelled  dynamics  scaled  by  any  /r  in  the  interval  (7.24). 


8  Conclusions  and  Directions  for  FY89  Effort 

We  have  demonstrated  using  a  combination  of  simulation  and  analysis  the  potential 
benefits  of  nonlinear  control  system  design  for  rapid  slewing  and  precision  pointing 
using  the  ideas  of  PFL.  In  the  next,  year  we  will  proceed  to  design  several  laboratory 
experiments  to  further  demonstrate  feasibility  and  to  test  options  for  implementation 
which  provide  robust  operation  with  imprecise  modeling  of  the  elastic  structure. 
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A  A  Lemma  for  Lagrangian  Modeling 

In  this  appendix  we  provide  some  useful  identities  for  performing  the  calculations 
indicated  above. 

Consider  a  spatial  coordinate  frame,  denoted  the  ‘body’  frame  rotating  relative  to  a 
second  reference  frame,  denoted  the  ‘inertial’  frame,  with  angular  velocity  oj  in  body 
coordinates.  If  the  relative  angular  position  is  characterized  by  parameters  £  <E  3 ,  say 
Euler  parameters,  then  u ;  =  T(£)£,  and  we  have  the  following. 


Lemma  1  Consider  a  function  A(u>),  where  o)  =  £(£)£.  Then 


'  d  dK  dK' 

T 

da 

dt  ~ot  ~ 

=  sr(0 

~ u)  x  a 

dt 

w 


here 


a  = 


dK\ 

do,  ) 


(A.l) 


( A .  2 ) 


Proof:  Direct  computation  yields 

dK 

di 

8K_ 

dt, 


and 

d  dK  dK 

HI*-  di 

We  need  only  show  that 


d_ 

dt 


3K_ 

do. > 


dK_ 

doo 


+ 


'(0 


S  kma 


dK_ 

do) 


m) 


dt, 


s(e)-^(s(oo  =  -fis(o- 

Let  rj,  denote  the  ith  column  of  E.  Then  the  above  matrix  equation  can  be  interpreted 
as  three  vector  equations 


cr,( £ )  £  =  <r,  -(-  o)  x  cr, ,  for  i  ~  1 , 2,  3 


d 

w 

The  validity  of  these  ecpiations  follows  from  the  observation  that,  each  cr,  is  a  vector 
denoting  the  coordinates  of  a  point  P  in  the  body  reference  frame.  The  quantity  on 
the  left  is  the  velocity  of  the  point.  P  in  the  inertial  frame,  whereas  &,  denotes  the 
velocity  of  P  in  the  body  frame. 


□ 
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B  Supporting  Computations  for  B-spline  model  of  planar 
slewing  with  uniform  Beam  appendage 


In  this  appendix  we  summarize  the  computation  by  explicit  integration  of  the  required 
tridiagonal  matrix  parameters  obtained  from  the  B-spline  finite  element  model  for 
planar  slewing  of  a  rigid  body  with  attached  appendage  consisting  of  a  uniform  beam. 
See  Section  4.4.1  for  details  of  the  model  development. 

By  definition,  the  N  x  N  matrix  N  given  in  (4.69)  has  elements  given  in  terms  of  linear 
B-splines  as 

[*]«  =  J‘ BU:)Bj_,(z)  dz 

for  i,j  =  1, .  .  . ,  N.  Given  the  “hat”  shaped,  linear  B-spline, 

B!(z)  :=(?)[--  -  .•(*))#<*)  +  (?)!<i  +  2)-  - 
where  the  zero  order  B-spline  is  chosen  with  continuity  from  the  left;  i.e., 


1,  if  ,Tj  <  x  <  x t+1 

0.  else 


(B.l) 


Then  we  have  three  nonzero  cases  to  consider. 
Case  1:  i  —  j  —  N .  Then 


1  (_ 
3  N' 


Case  2:  i  =  j  ±  1.  (Refer  to  Figure  2.1.)  Here  we  obtain  a  simple  form  for  the  integral 
by  transformation  of  the  variable  and  limits  of  integration; 

[JV)«  =  [  BUz)B]_,(z)  iz 

=  P  (f)2(- 

J  I 

=  (t)2  /  ‘V  -  z)  dx 

Jo 

(Jase  3:  i  —  j  <  N . 

[Af]0-  =  t  BUz)B}_llz)dz 
Jo 

=  ri(^2(=-  =j-,)2d:+  r  (*?(=;  -z?dz 

J-j-2 

=  +/*(*)’(*  -*)arfx 

Jo  Jo 

2  (_ 

3  N' 


-z)dz 

1  (_ 
~  6  N 
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Case  3:  i  =  j  —  1. 

(A"l«  =  -(?)  2/'V(iS-*)*:  =  -r. 

2o  2 

Under  the  assumptions  of  the  planar  slewing  model,  the  1  x  N  coupling  coefficient 
matrix  NT,  „  has  elements 

J  0 

for  i  =  1, . .  . ,  iV.  There  are  two  cases  of  interest. 

Case  1:  i  <  N . 

z)dz  =  £'  +  ‘(?)-~[z  -  *(j&)]rfr  +  £’"(*);[(*  +  2)(*)  -  z]  dz. 

Changing  limits  of  integration  by  the  transformation  ,r  =  z  —  z,  in  the  first  integral 
gives 

J:  (t)-[-  -  *U)]<k  =  (t)  (*  +  ijf)x  dx 

~  (£)2(g  + 

Changing  variables  (and  limits)  of  integration  in  the  second  integral  yields 

+  2)(i)-z\d;  =  (?)/"(x  +  (i+l)£)U-*)Ar 

J:,  +  l  Jo 

=  + 

From  which  we  can  obtain 

f‘ zB'i(z)d=  =  ({r)2(l  +  i). 

Jo 
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ABSTRACT 

A  model  of  tne  nonlinear  dynami  cs  of  a  deformable 
maneuvering  multi  boav  system  is  described,  wnereby 
elastic  deformations  are  modeled  by  restoring  forces  and 
dissipative  forces  at  point  mass  appendages.  This  model 
is  brought  into  bilinear  form.  Estimation  of 
deformations  occasioned  by  rapid  slewing  maneuvers  is 
carnea  out  by  a  filter  based  on  a  globally  eaui valent 
linear  model  of  the  bilinear  dynamics,  and  is  shown  to 
be  an  improvement  over  the  extended  Kalman  filter.  To 
further  alleviate  the  computational  burden,  the 
estimated  deformation  state  is  propagated  between 
observations  by  a  low  dimensional  operator  spline 
interpolator  of  bilinear  system  Volterra  series,  which 
is  easily  implemented. 

INTRODUCTION 

This  paper  proposes  a  new  nonlinear,  nonparaaetri c 
method  for  off  line  modeling  and  on  line  estimation  of 
tne  deformation  of  a  flexisle  structure,  undergoing 
rapid  rotational  maneuvers. 

In  these  ci rcumstances .  the  structural  stiffness 
and  damping  coefficients  depend  on  the  angular 
acceleration  the  angular  rate  <u  and  the  square  of  the 
angular  rate  m  .  In  tne  single  axis  case,  the 
excitation  of _ the^structure  is  represented  by  the 
vector  u  *  (w,  u  ,  2u),  to  which  the  structural 
dynamics  responds  as  a  "bilinear"  (i.e.,  parametrically 
excited)  system.  A  similar  technique  for  multiaxial 
rotations  yields  a  bilinear  model  with  respect  to  matrix 
valued  excitations. 

Two  methods  of  estimation  and  modeling  are  combined 
to  achieve  deformation  state  determination: 

a.  A  method  based  on  a  feedback  linear  lied  procedure 
whicn  gives  an  estimate  of  the  deformation  state  By 
means  of  a  filter  constructed  from  the  equivalent 
linear  dynamics,  whicri  is  faster  than  the  extended 
Kalman  filter. 

b.  The  modeling  of  tne  deformation  state  of  tne 
structure  by  means  of  Volterra  series 

i nte-polators . 


MODEL  OF  A  DEFORMABLE  STRUCTURE  AND  EQUATIONS  OF  MOTION 

For  purposes  of  illustration  of  the  principles 
involved,  our  structure  will  consist  of  a  primary 
mirror,  attached  to  a  spacecraft,  and  a  secondary  mirror 
attached  to  the  primary  in  the  shape  of  a  Cassegrain 
telescope  by  means  of  idealized  massless  links.  The 
primary  mirror  structure  will  also  be  regarded  as 
attached  to  the  spacecraft  by  means  of  a  massless 
link.  Equivalently  the  same  model  can  be  thought  to 
represent  a  laser  beam  expander,  as  in  figure  I. 

The  simplified  telescope  part  of  tne  structure  can 
itself  be  modeled  as  a  system  of  two  masses  attached 
together  by  a  single  "equivalent"  link  with  "equivalent" 
stiffness  and  damping  coefficients,  so  that  the  same 
restoring  forces  at  the  secondary  are  obtained  as  if 
with  more  than  one  link.  The  modeling  is  summarized  in 
the  appendix,  and  figure  2  illustrates  the  geometry. 

Expressed  in  the  body  fixed  coordinate  system  0(b’, 
b  ,  b^) ,  the  coupled  vibrational,  translati onal  and 
rotational  equations  oi  suen  a  structure  oecome: 
Vibrational : 

M  (y22y-(a*U2]yCa»Q2]p»U  }4Cy4Kyf 
0  o 

Translational: 

•a  ♦LI'h  ly*2Qy'[a-Q2]y)*LTf*f0 
0  o 

Rotational : 

( m o * j 1 (p  .y)*^J, ty .y) )m  • 
ulJ  * J , ( p  .y )*gJ,  (y .y) 1“  4 

O  I  ci 

r(e4y)TM0/4R) (w,fl4y )y-aoLTMoy4CRw4K w(a)da- 

t  ♦  r  c  o  *  y ) T  r 

y  denote*  the  ;2nxl)(for  planar  motion  or  (3nxU 
for  out  of  plane  motion)  matrix  of  deflection 
coord;  na*  «n  of  ru  rente-*  of  n  appe.ncug-s  from  their 
undeform.- J  positions,  n-2  in  the  ra*e  when  the  4"4c"',vy 
air-nr  and  the  spacecraft  platform  are  regarded  as 
ann**n»i*  of  tn*  primly,  T  l5  tn<s  torQu*  aDO’Jt  t^<? 


(■also  used  .  n  di“rmin»  S 

30  ‘.fiat. 


-  diagirj)  for  K,  ) .  are  chosen 


*  *  i  ■»  ocier  loop.  with  n  made  to  matcn  trie  real  syste« 
at  discrete  intervals  ny  re- j  ni  ti  al  l  zi  ng ; 


l  r 

i  . 


IB, 


’a/S 


are-s  S  *  jm.x  and  "a"  rounds  tne  ei  genvalues  o:'  A. 

:.e.  |exp  At  I  <  Sexp  :-2at..  far  square  integracie 
inputs  t  lower  sounda  on  tne  weignts  are  also  needed  wren 
tre  , nputs  are  not  <o,  out  are  Dounoed:  (Dwyer.  1986)). 

The  advantage11  of  such  modeling  are: 

•Tne  model  dimension  ;a  equal  to  the  number  of  tent 


i routs . 

•“ocel.ng  error  is  distributed  throughout  the  chosen 
input  signal  class  !i.e.  By  frequency  or  amplitude), 
rather  than  depending  on  nearness  to  a  single 
reference  trajectory. 

•The  interpolated  signal  (response)  can  Be  proven  to 
converge  asymptotically  to  the  true  system  response 
for  any  (unxnown)  excitat.on  in  the  cnosen  signal 

class . 


In  this  tecr.ai^ue  of  modeling,  we  can  record  tne 
real  data  \>'  ‘  ‘  .  o'*  By  exciting  the  real  system  with 
(constant  or  nonconstant)  test  inputs  to  construct  the 
; nte-poiatcr .  The  test  inputs  can  Be  cnosen  to  better 
approximate  the  expected  excitations  of  the  system. 

Thus,  we  can  deduce  that  the  real  system  time  responses 
are  used  for  model  matching,  rather  than  responses 
synthesized  from  the  mathematical  model. 

The  problem  with  this  technique,  however ,  lies  in 
tne  fact  that  we  should  nave  storage  of  curves  in  order 
to  compute  the  Cj’s.  This  numcer  is  equal  to  mxN  x  I®*, 
where  m  is  the  numcer  of  test  inputs,  N  is  the  dimension 
of  the  state  to  Be  moaeled  and  I  is  the  number  of 
possible  initial  values  of  each  component.  This 
difficulty  does  not  allow  the  system  to  run  in  real 
time:  e.g.,  for  the  case  of  n  point  masses  linked  by 
massless  but  elastic  connections  one  has  N  -  2n  in  the 
planar  motion  case. 


ON-LINE  ESTIMATION 


In  this  section  we  try  to  profit  from  the  last  two 
techniques  anq  create  a  more  effective  one  by  making  use 
of  tne  transition  matrix  spline  of  the  bilinear  system 
of  our  model: 


n(t) 


«(t.  t.  )n(t,  t,  ) . 

k  k 


In  fact  the  transition  matrix  spline  *  interpolates  the 
transition  matrices  ♦  correspond! ng  to  the  bilinear 
system  model  excited  by  constant  or  piecewise  constant 
test  inputs  u  .  This  permi ts  the  construction  of  the 
response  of  tne  real  time  system  in  piecewise  closed 
form,  thereby  replacing  response  curve  storage  by  an 
analytic  transition  matrix  generator,  rather  than  the 
construction  of  the  coefficient  interpolator  c.'s  from 

„2  „m,  1 


tne  output  test  signal  y’ly 
One  gets  c  -  ic?ql  f 


Y 

om  y  . 


-  (♦ 


where  * 


tne  (p,  q)  entry  in  tine  transition  matrix  with 
constants: 


pq 

(i  ) 


1  9 


♦  -  expl  ( A 


The  interpolated  transition  matrix  is  then  used  to 
update  between  observations  the  structural  state 
estimates  obtained  from  a  filter  based  on  a  globally 
feedBaCk-1 inear: zeq  transformation  (seen  in  section  3-') 
of  tne  bilinear  structural  model.  This  last  technique 
has  the  following  features: 


n(  t : 


nit 
.  < 

.n  contrast.. , 


n  ( *.  ) 
< 


rect  noGi*l;n^  o:‘  trv  I/O  operator 


continuously  tracks  tne  true  system  time 

l 

response  n  (ti.  But  in  this  case  c  Jt)  cannot  Be 
generated  analytically  and  must  Be  computed  off-line. 

•The  presence  of  an  additive,  even  if  not  active.y 
suppressed,  input  does  not  give  rise  to  a  steady  state 
tracking  error  observed  in  the  earlier  literature  wnen 
additive  as  well  as  multiplicative  inputs  are  present, 
as  is  the  case  for  rapidly  slewing. structures.  Indeed, 
a  convolution  correction  Based  on  *  can  Be  added. 

,  *The  numDer  of  Curves  to  Be  generated  is  only  m  x 
N“  instead  of  m  x  N  x  ± .  (wnere  again  N  -  2N  for  the 
example  of  a  struct  ir»  coraoosed  of  point  masses 
connected  By  elastic  appencagea  and  in  plane  motion). 

•The  possibly  mgn  dimensional  recursive  filter  can 
run  at  a  slower  sampling  rate,  consistent  with  on  board 
CPU  capabilities. 

Interpolation  Exam pie 


An  interpolator  was  designed  fur  tne  same  two 
bodies  beam  expander  model  praviousiy  descnoej:  The 
interpolator  was  optimized  for  input  vectors  u1  • 
u2,  u^)  of  the  form  'constant,  o,  o),  (o.  constant,  o) 
ana  (o,  o,  constant),  cnosen  with  a  negative  constant 
during  the  first  naif  of  a  '0  second  nominal  minimum 
time  rotation,  and  positive  during  the  second  naif,  with 
tne  deformation  state  re-i ni ti al i zed  at  mid  maneuver  (5 
seconds)  from  the  feedback-linearized  filter  described 
previously.  The  constants  were  selected  for  boundedness 
of  the  interpolator  according  to  (Dwyer,  1986)  in  effect 
uppe^  bounds  on  tne  expected 

u,  u  and  2w  respectively.  The  interpolator  response  is 
given  in  figures  6  and  7. 

DISCUSSION:  APPLICATION  TO  CONTROL 

The  computed  torque  which  will  orient  the  system  in 
the  required  maneuver  will  be  sensitive  to  model 
accuracy.  This  car  be  alleviated  by  variable  structure 
control  at  the  cost  of  chattering.  A  technique 
developed  by  Slotine  (198k)  suggests  that  if  we  know  tne 
error  between  tne  unknown  computed  torque  and  tne  actual 
computed  torque,  then  we  can  find  an  optimal 
interpolation  of  the  variable  structure  corrections  on 
each  side  of  the  ideal  sliding  surface  that  effects 
compromises  witn  the  accuracy  of  the  system  model  used 
for  torque  computation  and  the  control  bandwidth,  to 
track  in  an  optimum  way  the  requi red  trajectory.  This 
error  can  actually  be  derived  from  the  on-line  modeling 
of  the  state  deformat i on .  In  fact,  an  upper  bound 
exists  between  tne  unknown  true  structural  transition 
matrix  ♦  and  the  operator  spline  interpolator  ♦  (Dwyer 
!98o).  And  because  the  computed  torque  i«  related  to 
those  functions  througn  tne  equations  of  motion,  then  we 
Can  assume  that  an  optimal  computed  torque  correction 
compatible  with  the  robustness  of  the  mocei  can  be 
found.  This  will  be  reported  elsewhere. 
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*1  1  *1  1-*  1  *3 

x"  x^  p  ♦  xJb  ♦  x^  b 


J3  ■  p^b'*  p^b2  ♦  p-^b^ 


♦  b2  ^3 

*  •  ^  b  *  u>2  *  *y 

:  is  the  angular  velocity  vector  of  the  body  fixed 
coordinate  frame 


APPENDIX 


Notation  of  Symbols  Met  in  the  Text  and  Graphics: 
p1  Position  of  i-th  appendage  if  undefortned. 

Q(b!  b2  b^):  Body  fixed  reference  system 
c:  True  center  of  mass 

T  2  1 

N(n  ,  n  ,  n  ):  Inertial  reference  system. 


-1  -2  -»A 

0(b  .  b\  bJ). 


I  *  diag  tCm  and  L  -  col([I],  [I],..)  where  [I] 
denotes  the  3*3  Identity  matrix. 

0  “2 


Q  *  disgtw)  *  w  where  hi  •  w^  0  -Wj 

”“2  “l  ° 

M  -  diaglm1[I])  ^  N  ■  -ML  *  col  (y  [I]) 


c:  The  vector  from  body  fixed  coordinate  to  the 
instantaneous  center  of  mass: 


K  •  diag(Kl[I])  and  C  -  diaglc^IJ). 


e  •  u°  p°  *  Eu^ (x^s  5^ ) . 


T  (p)  •  [pi | p2 1 . . .  ]  ,  pj  defined  as  hi 


if  0  is  the  undeformed  system's  center  of  mass,  then: 


J  m  j.  .  ♦  r  tpwrtpi 

0  hub  o 


?J  JJ- 


J,(p.  y)  -  rTCp)Mo  r(y)  ♦  rT(y)Mor(p) 
Rj  (u,  p)  -  [m  (x  hi  ♦  uix  w)  | ...  3 


m°  ♦  I 

uJ  is  called  tne  mass  ratio  of  tne  J-th  appendage, 
and  u°  is  called  the  mass  ratio  of  tne  main  body.  ?'  is 
the  net  external  force  applied  to  the  (center  of  mass 


For  planar  motion,  every  third  rows  and  columns  are 
omitted.  One  then  has 

0-1 

u  •  8  k.  and  if  J  -  diag  {[(  ) .  then  the  3n  x  3n 

matrix  Q  is  replaced  throughout  by  the  2n  x  2n 
matrix  8J,  Q  by  8  J  -  -81  (where  I  is  now  the  2n  x  2n 
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SLEW-INDUCXD  OGrOftHkTlQM  SHAPING1 
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Aba t -act 

Computed  torques  for  pointing  ana  tracking  require 
compensation  for  slew-induced  structural, 

foreoody/af tDody ,  or  optical  train  alignment 

deformations.  hereafter  callea  deformations.  Thus  even 
If  only  llne-of-31  gr.t  va-lasles  are  to  be  comraanaea, 
yet  full  state  feecoack  Is  neeaea.  The  solution 
proposec  here  Is  to  aecoupie  by  feedforward  of  the 
llne-of-slgnt  slew  aynamlcs  Into  the  aeformatlon 
control  loop.  It  Is  also  shown  In  this  paper  how 
arbitrarily  few  actuators  are  neeaea  for  such 
deformation  shaping,  at  the  cost  of  higher 
ai fferent iabl 11 ty  of  the  reference  llne-of-slgnt 
aynamlcs.  The  low  rates,  single  axis  case  Is  aevelopea 

In  di»ra1  1  (  •nnanl  1  J  f  v  *r»  hitTf*  raf  anrt 

multiple  axes  by  global  feedback  linearization  Is 
out  1 1 nea . 

Introduct 1  on 

In  recent  work  on  the  control  of  robots  with 
elastic  Joints,  the  state  of  the  coupled  rigid  and 
elastic  dynamics  Is  forced  to  evolve  In  a  "slow" 
Integral  manifold,  so  tnat  the  elastic  distortion  to 
the  computea  torque  becomes  a  transient,  l.e.,  the 
"transversal"  (of f-aantf old)  dynamics.  That  approach 
la  followed  here  In  treating  the  problem  of  slewing 
with  deformable  bodies,  to  snow  how  a  family  of 
control-dependent  slow  manifolds  can  be  constructed,  on 
each  of  which  the  slew-induced  deformations  are 
expressible  In  terms  of  (higher  derivatives  of)  the 
slewing  angle.  This  relieves  the  bandwidth 

requ 1 rements  of  the  primary  slew  actuator,  but 
generally  requires  that  slew-generated  "aeformatlon 
shaping"  forces  or  moments  also  be  applied,  such  as 
through  available  structural  actuators.  In  the  absence 
of  sufficient  natural  damping.  It  Is  shown  how  a  "fast" 
correction  can  also  be  applied.  Involving  an  on-line 
synthesis  of  the  "transversal"  part  of  the 
deformation.  This  requires  higher  control  bandwidth 
than  If  only  the  slow  control  were  used,  but  only  from 
the  deformation  shaping  actuators,  not  from  the  slew 
actuator.  The  role  of  "prior"  or  "posterior"  global 
feedback  linearization  for  the  extension  of  the  method 
to  the  raultlaxlal  or  high  rates  situation  Is  then 
outlined,  as  well  as  the  1  nter pretatlon  of  the  slow 
manifolds  as  sliding  surfaces  for  robust  variable 
structure  control  Implementation. 


where  rotation  about  an  axis  through  the  undeformed 
center  of  mass,  measured  by  the  angle  8  In  radians  la 
presumed,  entailing  deformations  representea  by  an  nxl 
column  matrix  ^(t)  of  generalized  cooralnates.  A 
torque  t  about  the  same  axis  with  respect  to  which  the 
attitude  angle  8  Is  measured  entails  matching  rotation- 
aefo-matlon  coupling  coefficients,  a  •  fi.  Deformation 
shaping  forces  or  moments  are  encoded  by  the  mxl 
matrix  £  of  generalized  forces.  To  fix  Ideas,  the 
central  hub  wi  tn  symmetrically  placed  and 
antisymmetrically  deforming  cantilevered  appendages 
developed  in  [1]  can  be  considered,  wherein  the 
coefficient  matrices  as  well  as  deformations  are 
expressed  In  terms  of  assumed  mode  shapes. 

nonl Inearl  ties  arising  from  gyroscopic  effects  or  full 
spatially  distributed  deformation  dynamics  or  both,  are 
found  in  [2],  [3l.  [n],  [52,  but  then  time-varying 
dynamics  or  unbounded  operator  coefficients  arise,  for 
wnic.n  the  present  method  is  still  under  development. 

Slew-Induced  Deformations 

The  standard  "proportional  plus  derivative" 
control  law  given  by  Eqn.  (3)  requires  feedforward  of 
measured  structural  acceleration  to  the  pointing  and 
tracking  torque  control, 

*  -a  *  .  •  -e  *7  - 

T  -  J  8  ♦  C  8  ♦  k  8  *  n  J£ 

-  a,(e  -  e*}  -  ao(e  -  a*)  (3) 

> 

where  hats  denote  estimates  and  8  is  the  commanded 
angular  trajectory.  With  a  good  model  and  good  sensors 
the  closed  loop  dynamics  Is  then  approximated  by  Eqn. 
00. 

J  48  *  (c  ♦  •,  )b8  ♦  (m  ♦  *0)A9  "  £  (*0 

e 

where  A8  :  •  8  -  6  and  no  structural  controls  ‘per  se‘ 
are  applied:  f  *  0. 

Besides  the  (everywhere  present)  question  of  model 
accuracy,  the  need  for  high  bandwidth  slew  torque 
actuators  and  for  full  order  structural  sensing  arises. 


Deformable  Rotational  Dynamics 


Exact  Slow  Ma-.lfolds 


The 
given  by 

J  8 


model  for  a  rotating  body  to  be  used  here  Is 
Eqns.  (I),  (2). 

♦  c  8  ♦  k  8  •  nT/  -  t  ♦  eTf  ( 1 ) 


H  I  •  ^  •  Kv  •  C  8  •  E f 


(2) 


Following  [61  -  [8]  In  part,  It  Is  shown  hare  how 
deformation- Induced  line  of  sight  disturbances  oan  be 
reduced  to  transients:  Eqns.  (1),  12)  are  first  put 
into  singular  perturbation  form:  Let  K  be  a  normalized 
stirrness  matrix,  so  tnat  one  has  K  expresses  In  terms 
of  K  and  a  perturbation  parameter  t  >  0: 

K  •  cK  (5) 


1  Research  supported  In  part  by  SDIO  and  managed  by 
AFOSB  (  A FSC )  under  contract  F*< 9620-87-C-01 03  ,  and  by 
NASA  Grant  HAC- 1 -61 3- 


I 


Without  loss  of  generjll*y  on*  may  act  H  *  I  •  identity 
•no  K  •  dlag  U,  wltn  m  <  t,  <  ....  than 
•et  ci  •  «  .  so  that  K  •  dlag  1 1 .(w  /w  . 
Whatever  the  physical  Interpretation,  one  May  seek 
polynomial  controls  In  the  paraaeter  c, 

'  m  •'o  *  *  •••  *  e\  (6) 


Ur  •  a  a  •  e  r 


*  Tj-i  *  -JT  ij-i 


HtJ  *  C*j  * 


t  •  f  ♦  ef  ♦  . . .  *  tpf 
— O  — 1  — c 


for  J  •  0 . p-2,  ana 


auch  that  the  deformations  oan  be  expressed  as 
perturbations  from  the  rigid  body  Halt  as  c  •  0,  l.a.. 


T  "  T  . 

n  x  •  t  *  a  f 
Pi  p  —  —p 


l  -  ez  *  x'  (8) 

with  the  normalized  deformation  £  (which  has  units  of 
fo.ee)  also  a  polynomial  In  e. 


£  *  2*  *  ‘P-1  £5,., 


and  j^'Ct)  *  0  is  t  ♦  Indeed,  insertion  of  Eqns.  (5) 
and  (8)  into  Eans.  (1)  and  (2)  brings  the  latter  to 
singular  perturbation  fora. 


J  8  ♦  ci  *  ke  ♦  c  n^z  •  t  ♦  e^f  ♦  v 


c(mz  ♦  Cz)  ♦  Kz  *  d  8  -  Ef 
where  the  disturbance  v  1s  given  by  Eqn.  (12), 


and  Is  governed  by 


M  z  ,*  Cz  ,  -  E  f 

-p-1  p-1  -p 


where  z  •  0  Is  presiaaed,  so  that  If  one 
sets  t~P*  0  and  f  •  0  for  J  1  p  ♦  1  then 
also  i,  *  0  for  J-'i  p.  Thus,  the  postulated  polynomial 
solution  given  by  Eqn.  (9)  Is  verified.  In  particular, 
no  convergence  considerations  arise  and  no  truncation 
la  needed  (hence,  the  term  "exact  slow  manifolds"). 
This  Is  possible  If  and  only  If  Eqns.  (16)  -  (21)  can 
be  sn'ved  for  tj.fj.  J  •  0 . p.  as  discussed  next. 

Deformation  Suppression 

The  simplest  choice  of  alow  manifold 
la  z  •  0,  which  exists  if  and  only  If  it  Is  possible  to 
solve  Eqn.  (22)  below  for  t  and  f  . 

A  “O 


pres  used 


sets  t"^*  0  and  f  •  0  for  J  1  p  ♦  1 

also  z*  •  0  for  p.  Thus,  the  postulated  po 


O  v 

♦o<*>»  *  «Q(  )  ♦  (  ) 

f  o 


M  i'  ♦  C  i'  *  K  l'  -  0  (13) 

If  c  -  0  then  z  •  z  lies  In  the  "rigid  body 
manifold",  “  ”° 


♦o(a)  *  t 


Js  *  cs  ♦  k 


£0  ■  *  ’  (E’I  -  d-T  ♦  £•  9  ♦  k'9)  -  ho(8.S.T.f)  (1H) 


8’  •  E  '  dJ  ,  d'  •  J  '  d ,  c'  •  d J  ' c  and 

k'  •  d  J  Then  by  Tychonov's  theorem  of  singular 
perturbations  [6],  for  (In  general  small 
enough)  c  >  0  there  Is  also  a  neighboring  "slow 
manifold", 


-  "  *o  *  ‘*1 


...  -  ht(e.e,r.t.r.;,..) 


where  if  z(  t  )  -  h  (at  tQ)  then  z(t)  -  h  (at  t)  for 

all  t  l  t0.  0  1  ~  « 

In  particular,  slow  manifolds  oorrsspondl  ng  to 
polynomisl  controls  In  e  csn  be  found  thst  yield 
polynomisl  representstlons  In  c  (in  which  ease  c  need 
not  be  "amsll")i  indeed.  the  Insertion  of  the 
•xpsnslons  (6),  (7)  snd  (9)  Into  Eqns.  (10)  and  (11), 
followed  by  collection  of  equal  powers  of  t,  yield  the 
following  recursive  foraulss, 

J  #  ♦  ci  *  k*  -  t  ♦  «Tr  ♦  v  (16) 

0  “O 


1  e 


obtained  by  setting  z  •  0  In  Eqns.  (16)  snd 
('7),  snd  then  Laplice-transformlng  (the  same 
symbols  9.i.f.t,£  will  be  used  botn  in  the  time  and 
frequency  domains). 

Noting  that  dim  t  •  (l*n)  x  (!•■)  (where  n  * 
dim  %  and  m  -  dim  f),  Pt  is  seen  that  t  Is  squere  If 
end  only  if  m-n  ("independent  model  spSce  control"). 
Then  c  Is  invertible  If  snd  only  If  E  Is  Invertible; 
Indeed  then  Eqns.  (16),  (17)  yield 


(j  •  i  E  'fl)8  •  c8  •  k8  ■  i 


E*'  d  9 


Letting  69:  •  *  -  9  ,  the  trecklng  problem  is  then 
rsduoed  to  s  rsgulstor  problem  based  on  the  reduoed 
Slew  dynsmloe  given  by  Eqn.  (25),  thst  Is,  to  the 

oholet  of  s  etsbllltlng  rsgulstor  H  (s)  for  the  block 

o 


dl agram  1 n  F I gure  1  : 


(m»  ♦  c]k  da 


ana 


e,  (s ) 


T  -1_  2 

-  n  K  Ea 

-  [Ma  ♦  c]k‘’e3 


(31 ) 


(32) 


Figure  1 

The  alew  torque  la  then  given  by  Eqn.  (27): 

i  •  •  (J  -  eVdjaS*  -  Hq(s)A9  (27) 

For  Eqn.  (25)  to  be  a  valid  alew  dynamics  model, 
It  la  alao  neoeasary  to  apply  a  deformation  auppreaalng 
control  f,  which  la  found  from  Eqn.  (26)  by  lnaertlon 
therein  of  the  clnaed  loop  pointing  angle  9  found  by 
lnveralon  of  Eqn.  (26): 


£  *  -  E  ’ds2i(j  -  eTE  'd)a2  *  ca  ♦  k)  «  E  'da29* 

-  E'1  da2 1 ( J  -  eV’dla2  *  ca  ♦  k } ~ 1 H  (a)A9  (28) 

—  —  o 

In  particular,  if  a  proportional  and  derivative 
regulator  H0 ( a )  -  a. a  ♦  a0  la  aelected.  the  cloaed  loop 
pointing  error  dynamics  becomes  aa  ahown  in  Eqn.  (29): 

(J  -  eTE  1  d )& a  *  (c  ♦  a  )A9  »  (k  ♦  a  )49  -  v  (29) 

•  o 

In  contrast  with  Eqn.  («).  the  driving 
term  v  -  -  n‘^‘  la  a  transient  aa  expected,  and  yet, 
unlive  Eqn.  (3),  no  hi  gh  frequency  correction  term  la 
needed  In  the  alew  control  law  of  Eqn.  (27).  The  need 
for  structural  aenaora  and  high  bandwidth  actuators  In 
the  Implementation  of  the  control  law  given  by  Eqn.  (3) 
la  now  replaced  by  the  need  for  full  order  structural 
control.  This  la  alleviated  next. 

First  Order  Deformation  Shaping 

If  cq  In  Eqn.  (22)  la  not  Invertible,  the  system 
cannot  be  "rl  gi  df  led" ,  but  the  coupling  term  n1^  can 
ail  11  be  replaced  by  the  fast  transient  plua”hlgher 
derlvatlve  terms  in  the  pointing  variable  9.  The 
simplest  choice  of  such  a  alow  manifold  Is  :  •  z  , 
which  exists  If  and  only  If  It  la  possible  to  so?ve 

Eqn.  (30)  below  for  i  ,t,.f  and  f  , 

O  1  — O  —  1 

l,(a!  8  •  t,  (a )( i0.£^.et, .  e  r  ‘  )T  «  (v,o,0T)T  (30) 

where 


Equations  (30).  (30.  (32)  are  obtained  by  solving  Eqn. 

(17)  for  z  .  to  yield 
— o 

^  -  k  *' (E  ^  -  ds2e|  (33; 

In  the  frequency  domain,  then  inserting  Eqn.  (33)  Into 
Eqr.3.  (16).  (20)  and  (21)  with  p*l  (hence  z,  -  0). 

Noting  that  dim  c  (a)  •  (2*n)  x  (2»2m),  It  la  seen 
that  c.!a)  la  square  if  and  only  If  m»n/2.  In  this 
case.  If  c,j(a)  la  generlcally  invertible  one  may  set 

e“ '  (a  )♦,  ( a  )  -  :  (t^(3)  ,/(a)T,  Y*(s),l[(a)T)T  (3<0 


(which  la  Independent  of  c),  and  then  define  the  alow 


transfer  functions  for 

T  -  T  ♦  CT, 

and  f  -  f  ♦  cf,  aa 

follows  : 

O  1 

—  — o  -1 

7T(3)  :  -  r(3)  * 

O 

?J(3) 

(35) 

f 

7~(a )  :  .  t  (s )  * 
— o 

if (a) 

(36) 

Equation  (30)  then  yields 


(37) 

(38) 


where  the  transient  disturbance  v.  Is  given  In  terms 
of  v  of  Eqns.  (12)  and  (13): 

v,  *  ( 1  I°T  I  0T)  c,(,>-’U.0.0V  (39) 

No  transient  appears  In  Eqn.  (38)  because,  Instead 
of  directly  Inverting  all  of  1,(3),  It  Is  possible  to 
solve  separately  for  t  In  terms  of  f  (and  9)  from 
Eqn.  (16)  and  for  t,  In  terms  of  f  and  f,  from  Eqn. 

(20) ,  while  [f  ,c£,  )  are  obtalnabl?  only  from  Eqn. 

(21)  with  z^  from  Eqn.  (17),  neither  of  wnicn 
contain  v. 

The  tracking  problem  Is  now  reduced  to  a  regulator 
problem  baaed  on  the  reduced  slew  dynamics  given  by 
Eqn.  (3  ),  that  la.  to  the  choice  of  a  stabilizing 
regulator  H,(s)  for  the  block  diagram  of  Figure  2: 


T T  ( 3  )  9  •  T  *  v, 
7r!s)9  •  f 


ll<*> 


T-1  * 

n  K  da 


(ca2  ♦  ca  •  k, 


Figure  2 


The  low  bandwietn  slew  torque  oontrol  1*  then  fl  ven  by 
Eqn.  (HO): 


to  oonatruct  the  elow  trenafer  functions  for 


i  -  t  ♦  ct  -  t T ( * ) ~  e  -  H,(a)ae  (HO) 

O  1  I 

For  Eqn.  (37)  to  be  a  valid  slaw  dynamics  model, 
It  is  again  necessary  to  apply  a  deformation  shaping 
oontrol  f,  which  la  now  found  from  Eqn.  (38)  by 
Insertion  tnereJn  of  the  closed  loop  pointing 
angle  9  found  by  Inversion  of  Eqn.  (37): 

f  -  lo  ♦  tf,  -  7f (s)T1 (a)_1T  -  Tf(a)9* 


p  ,  P  j 

t  •  I  ci  and  for  f  -  l  c  f.  . 
j-0  J  J-0  J 


7  (a) 6  •  t  ♦  v 


7* (a )B  -  f 


7*  ;a)7T(a)_1H5 ( a )A8 


The  closed  loop  pointing  error  dynamics  now  becomes  aa 
ahown  In  Eqn.  (1:2): 

|7T(a)  *  H 1  C  a  ) }  A8  -  v,  (H2) 

j.It  turns  out  that  each  scalar  component  7^(a) 
of  7  (a)  has  the  same  number  of  poles  and  the  same 
number  of  zeros  as  7 '  f  a )  .  In  particular,  the  poles 

of  7T(a)  and  of  eacn  t‘(s)  are  given  by  det  c^(a). 

Thus,  only  the  compensation  H^a)  determines  the 
number  of  derivatives  of  tne  pointing  error  A6  that  are 
needed  to  generate  £  from  Eqn.  (ill),  as  well  as  t  from 
Eqn.  (HO).  This  Is  an  exact  generalization  of  the 
"Independent  modal  space  control"  case  given  by  Eqna. 

(27)  and  (28).  In  particular,  the  high  frequency 

disturbance  to  the  slew  dynamics  Is  again  reduced  to  a 
transient  (now  v1  ) ,  and  no  high  frequency  correction  is 
needed  for  the  pointing  control  torque  t. 

P  -  Th  Order  Deformation  Shaping 

More  generally.  a  slow  manifold  with  the 
representation  of  Eqn.  (9)  as  a  (p-l)-th  order 

polynomial  In  c  exists  If  and  only  If  Eqn.  (H3)  below 

can  be  solved  for  tj ,  £  ,  J  «  0 . . 

♦  (3)9  -  c  (a ) ( t  ,f  T . ePT  ,cPfT)T 

v  p  o  — o  p  —p 

♦  (v.o . oT]T  <»3) 


where  *  (a)  and  c  (a)  are  found  by  successive 

elimination  of  z£ . z  In  Eqna.  (16)  -  (21). 

N°w  £p<3)  *3  (p*T»n)  -  Slmenalonal  and  dim  cp(a)  • 

( p • 1 ♦ n )  x  ((p*l)  x  (1-m)).  It  follows  that  c  (a)  la 

P 

square  If  and  only  If  the  following  relation  holds  true 
of  n  *  dim  j£,  m  •  dim  f  and  p  • 


7T (3  )  •  I  7*(a) 
j-0  J 


7  (a)  -  I  7*  (a) 
j-0  J 


and  the  transient  v  la  again  found  from  u  of  Eqna. 

(12)  and  (13):  P 


vp  -  (1.0T. 


,1,OT)cp(a)'1(v.0 . 0.0T 


Again  no  transient  appears  In  Eqn.  (H7)  for  f, 
only  In  Eqn.  (H6)  for  t.  This  la  because,  Instead  of 
directly  Inverting  c  (s),  It  la  also  possible  to 
proceed  aa  follows:  p 

(a)  Solve  recursively  for  z  In  terms  of  £  for 

J-0,...,p  (and  2p  derivatives  of  8)Jfroo 
Eqna.  (17)  and  (19),  which  do  not  contain  v; 

(b)  Insert  z  In  terms  of  £  'a  Into  Eqn.  (21), 

which  fJ  decomposable  ttito  n  equations  In 

(p»1)  m  unknowns  (the  m  components  of  £  for 

J-0 . p,  where  here  n  •  ( p-i  )  m  according 

to  Eqn.  (HH),  again  not  containing  v; 

(c)  Solve  recursively  for  tQ  In  terms  of  f  from 

Eqn.  (16)  (through  which  v  appears),  then 


for  in 


terms  of  f^  and 


-j . I<j 


(through  z^)  from  Eqn.  (18). 


It  la  from  (b)  that  Eqn.  (#7)  arises. 

Independently  of  v,  and  from  (c)  that  Eqn.  (»6)  arises. 

Again  the  tracking  problem  is  reduced  to  the 
design  of  a  stabilizing  regulator  Hp(s)  replacing  Hj(a) 
in  the  block  diagram  of  Figure  2,  where  the  high 
frequency  transient  v  replaces  v, ,  with  Eqn.  (H8)  now 
P  1 

giving  the  transfer  function  7T(a)  1  Instead  of  Eqn. 
(35). 


2p  derivatives  of  9  then  determine  the  slow 
part  cz  of 

For  an  Invertible  cp(a)  one  again  sets 

V,r'*p  (s)  *  '  (Y0(,)'  ^<3>T . 

Ipt*>T)T  (15) 


The  consequent  low  bandwidth  slew  torque  t  Is  then 
given  by  the  counterpart  of  Eqn.  (HO),  and  the  shaping 
control  £  by  the  counterpart  of  Eqn.  (Hi),  with  H,(a) 
replaced  by  H  (a)  and  with  y’(s)  and  7  (a)  found  from 
Eqna.  (H8)  and  (H9) . 

Fast  Control 

If  there  la  Insufficient  or  non-exlatent  "a 
priori"  damping  C  In  the  deformation  dynamic*  for 
adequate  time  scale  separation,  the  shaping  oontrol  ean 
be  augmented  by  a  "fast*  term  f ’ ,  as  advocated  In  the 
singular  perturbation  literature,  e.g.,  [6]  and 

references  therein.  That  la,  Eqn.  (Hi)  for  £  (or 
It*  H  (t)  counterpart)  oan  be  replaced  by  Eqn*.  (51) 


(62) 


and  (5?)  Below,  with  no  cnange  to  Eqn.  (HO)  for  t  (or 
to  Its  Hp( a )  oounterpart ) , 

f  -  Tf(a)  (a -t  -  r  (5D 


I’-  *,(i  -  c  r)  *  Ajx  -  c  r)  (52) 

where  ^  and  x  now  oust  be  obtained  from  daforaatlon 
sensors,  but  cz.  cz  from  Eqn.  (9),  hanoe  In  teras  of 
tne  Xj'»t  l.e...  of  t  for  J“° . p. 

Since  the.  "fast"  off-manlfold  tera  In  Eqn.  (8) 
Is  aodeled  by  jr  -  cz.  It  follows  that  f'  is  nothing  but 
proportional  plus  derivative  control  of  the  fast 
dynamics.  In  particular,  f '  ♦  0  as  required  in  [6]: 
Indeed,  tne  fast  dynamics  of  Eqn.  03)  Is  now  replaced 
by  that  of  Eqn.  (53). 

"  i’  ♦  [c  •  Aji1  *  [k  •  A0ll'  -  0  (53) 


hence  i'  "  0  by  designer-selected  cftoloe  of  the  gains 
and  Aq.  ~ 


c,3(a)T  -  (O.-i. 0,0) 

£,4(a)T  •  (o.-e.-e, ,-e2)  (63) 

so  that 

det  e1  (a)  -  *  cj^ki 

-  (a  *  o2)/k2)a  •  i  42(a)  (6k) 


Inversion  of  c.(a)  yields  the  following  fortes  of  Eqna. 

(35)  and  (36). 


tT(s) 


irf(a) 


Pg(s) 

62(S) 

p[(a) 

«2(a) 


(65) 

(66) 


In  the  above  approach,  no  change  Is  needed  In  the 
slow  dyr.is.cs  ar.d  corresponding  oontrol  laws,  where  the 
or!  gl  nal-  K  and  C  are  retained,  provided  v  is  replaced 
by  v  -  e‘f’  (-  0)  wherever  appearing.  An  alternative 
Is  to  design  the  fast  oontrol  first,  l.a., 
omit  cz,  cz  from  Eqn.  (52),  with  consequently  greater 
simplicity  In  the  Implementation  of  f ' .  But  then  C 
must  be  replaced  by  C  *  A,  and  K  by  K  *  A  In  all  the 
slow  control  algorithms. 

Example 


Let  n-2  and  m-1,  hence  p-1 ,  ao 
that  x  •  z  for  appropriate  choices  of  t  ■  t  ♦  ct.  and 
°f  _  X  -f  *  f  ♦  cf.  .  _  Let  also  °  E  -  e1 
e2)  .  £  -  e,  d  -  (d  ,d2)  ,  n  -  d,  M  -  I,  C  •  dlag  (c., 
c2)  and  K  -  dlag  (k,,  fc2)  ■  One  then  finds 


*1(3)  *  (♦,! 

where 

(s),  ♦12(3).  6,3(8).  ♦,„(a)T 

(5k) 

♦,,(s) 

-  Js  ♦  cs  ♦  k 

(55) 

♦,2(s) 

-  (d^/k,  -  d22/k2)s'’ 

£56) 

♦13(s) 

-  (s  •  c^Cdj/k^s3 

(57) 

♦,,(s) 

-  (s  ♦  c2)  (d2/k2)s3 

(58) 

and 

«,(»>  *  [*n  (»)  •  £,  2(*)  •£,  3<»)  .£,),(•)]  (59) 


where 

£,,(a)T  -  (1,0, 0.0) 

e12(»)T  •  (e.ld^ej/k,)  ♦  d2(e2/k2)la2  . 
(•  ♦  0|)(«l/k,)«,(B  ♦  c2)(e2/k2)a) 


(60) 


wnere  the  denominator  is  the  quadratic  polynomial  given 
by  Eqn.  (6k),  while  the  maerators  are  6-th  degree 
polynomials. 

In  the  Idealized  case  of  a  perfect  slew  actuator, 
l.e.,  c-0  and  k-0  in  Eqn.  (1).  as  well  as  no  structural 
damping,  l.e.,  C-0  In  Eqn.  (2),  so  that  e,  -f  c?  -  0, 
the  numerator  and  denominator  of  YT(s)  and  Yr(s)  take 
the  forms  below. 


P6  "  *  *o^/k1k2 

(67) 

Pg(s)  •  s^ibjS2  ♦  PQ)/It1k2 

(68) 

where 

2 

6«(8)  -  s  c  /k.k, 

(69) 

*0 

*1*2^ k2  k1  ^  *1il2kl  ’  *2<31  k2 

(70) 

*2 

eie2^dl  *  d2  )  *  d1d2^*2  *  *1  ^ 

*  d2el  •  d1  *2 

(71) 

b 

O 

‘  Vlk2  •  *1  d2k  1 

(72) 

b2 

’  d1*2  •  d2*1 

(73) 

co 

-  •1*2(k2  *  k,  ) 

(7k, 

It 

follows  that  the  transfer  function 

to  be 

regulated  In  the  block  diagram  of  Figure  2  becomes  the 
"type  2"  system  shown  in  Eqn.  (75), 


Y^ef1 


»2(*2»2  *  «0) 


(61) 


2 


(75) 


wnlcn  o an  be  stabilized  by  a  "damped  PID"  controller  of 
tne  form  given  In  Eqn.  (76)  i 

H 1  ( 8  )  •  k(s2  ♦  ♦  pQ)/(s  *  q)  (76) 

In  particular,  by  matcnlng  coefficients  of  the 

closed  loop  transfer  function  wltn  those  of  (a 

*  A)  ,  the  filter  parameters  can  be  chosen  to  be  q 

-51.  K  -  I0l3a2  -  aod,  p,  -  5l“/c0K  and  p0  -  1/eQK. 

provided  one  selects  1  -  /a^TToa^  as  the  "slow  time 

constant"  (wnenever  aQ  and  have  the  same  sign). 
Hore  generally,  any  control  design  aethod,  be  It 

LQR,  H  or  co-prime  factorization,  can  be  used. 

The  "slow"  part  of  the  shaping  control  Is  then 
given  by  Eqn.  (Hi),  wnere  the  feedback  part  consists  of 
the  compensation  H^s)  selected  as  above  for  use  in 

Eqn.  (HO),  cascaded  with  the  two  stage  lead-lag  filter 
given  below: 


Tf(s)YT(s)'1  -  (b2s2  ♦  bo]/(a2s2  *  aQ)  (77) 


In  the  absence  of  damping  as  presumed  here,  a 
"fast"  correction'  to  f  must  be  added,  in  accordance  to 
Eqn.  (52),  where  kQ  and  A,  are  freely  chosen  to  Impose 
time  scale  separation.  The  required  "slow"  term  ez  in 
f  is  found  from  Eqn.  (33).  yielding  the  expression 
below  in  terms  of  the  independently  designed  alow 
Slewing  torque  t  : 


1  ~  1’  m  c2-,  *  K  ' i ( 3 )  *  £32|7t(3)  \ 


el/k1  b-s2  ♦  b 
i  2  o 


e2/k2 


-  ( 


d2/k, 


V 


d2/k2  ^a’a 


2  .  1  2 

ao]s 


(78) 


Extensions  to  Robust,  Multlaxlal  and 
High  Slew  Rate  Control 

It  Is  possible  to  extend  the  design  methodology 
proposed  herein  to  multiple  slew  axes  as  well  as  to 
high  slew  rates.  In  which  case  stiffness  and  damping 
coefficients  In  Eqn.  (2)  acquire  angular  rate  and 
angular  acceleration  -  dependent  terms,  while  the 
rotational  dynamics  of  Eqn.  (1)  acquire  "vector 
product"  terms:  cf.  DO.  [5].  In  this  situation,  the 
reduced  order  slewing  dynamics  obtained  by  inversion  of 
Eqns.  (16)  -  (21)  become  nonlinear.  It  Is  then 
possible  to  first  globally  feedback-llnearlze  the 
nonlinear  counterparts  of  Eqns.  (1)  and  (2)  with 
respect  to  pointing  variables,  such  as  in  [9],  [10]  and 
elsewhere.  Alternatively,  it  may  be  possible  to  first 
Invert  the  nonlinear  counterparts  of  the  recursive 
Eqns.  06)  -  (21),  to  obtain  nonlinear  versions  of  the 
decoupled  Eqns.  (H6)  and  (H7)  for  the  slow  dynamics, 
and  then  see*  to  globally  feedback-llnearlze  Eqn.  (H6) 
(Eqn.  { H 7 )  ’ s  counterpart  can  be  directly  used  to 
generate  the  shaping  control  f  from  t  without 
linearization) . 

Finally,  the  question  of  sensitivity  to  modeling 
errors  may  yield  to  variable  structure  oontrol 
Implementation:  the  presence  only  of  the  shaping 


oontrol  f  In  Eqn.  (2)  oan  be  exploited  to  design  an 
"Interpolated  awltcnlng  control”  following  [11],  with 
the  selected  slow  manifolds  regarded  as  the  switching 
surfaces.  The  pointing  oontrol  t  oan  then  be  designed 
for  the  reduced  order  dynamics  on  the  switching 
surface.  by  the  "hlerarcnl cal"  method.  These 
extensions  will  be  discussed  elsewhere. 
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For  the  case  of  5>y- incuc-d  structural  deformation 
estimation  yy  f ,  nd  F,  *  I  and  Fj  •  lower  $alf  of  8(X) 
defined  before.  In  part.cuiar,  we  find  a.  ■  R.,  so 
that.  m  contrast  to  the  extended  Kalman  filter,  only 
tne  3- i ndependent  forcing  term  of  tne  Riccat;  equation 
gi yen  oy  Q'  nas  to  oe  updated,  all  otner  coefficients 
seme  now  constants.  3y  using  tnis  procedure  a  251 
increase  in  speed,  wit.n  251  increase  in  accuracy  nas 
been  found  in  preliminary  simulations.  Even  so,  we 
still  need  to  process  a  very  nign  data  rate  of  sensor 
measurements ,  wmon  is  not  easy  to  implement,  especially 
in  space  structures,  causing  time  delays  in  estimation. 

Estimation  Example 

A  simolified  mode;  of  a  ream  expander  was 
represented  by  a  primary  mirror  .mass  elastically  linked 
to  a  secondary  mirror  mass.  Restoring  fo roes  and 
dissipative  forces  proportional  to  relative  secondary 
mirror  motion  were  modeled  at  tne  secondary.  A 
piecewise  constant  angular  acceleration  was  commanded, 
representing  tne  accelerati on-deceleration  profile  of  a 
minimum  time  retargeting  maneuver.  Presumed  angular 
accelerometer  and  gyro  noise  covariances  were 
transformed  into  equivalent  process  noise  for  tne 
feedback- linearized  filter,  witn  the  additional 
simpl lfication  of  neglecting  a  squared  noise  term 
corresponding  to  the  second  entry  u^  •  u  of  the 
equivalent  input  u.  Presumed  strain  gauge  sensor  noises 
were  taken  from  the  literature.  The  relative 
performance  of  tne  extenOed  Kalman  filter  and  the 
feedback- linearized  filter  are  seen  by  inspection  of 
figures  3.  9  and  5. 

OFF  LINE  MODELING 

In  this  subsection  we  use  the  newly  developed 
method  of  Bilinear  System  Optimal  Interpolation.  This 
technique  applies  to  dynacicai  systems  which  benave  in 
"normal"  bilinear  form,  (by  active  suppression  of  the 
constant  bias  additive  term  b; 

X  -  AX  ♦  8( X  )u 


V:  u-y 


from  trie  excitation  vector  u  to  an  output  vector  y  (such 
as  -j  introduced  before)  is  imDedded  In  a  Hilbert  space 
of  (I/O)  operators  of  candidate  bilinear  systems, 
equipped  with  a  reproducing  kernel: 

K^'u,  v)  -  exp  J  u'(s)R  v(s)ds 
t 

o 

wnere  the  weignt  matrix  R  is  determined  by  bounds  on  tne 
structural  frequencies.  An  interpolator  o:  tne  form 

V. (u)  -  10. (t)K  £u,  u1) 

t  i  1  6 

is  constructed,  tuned  so  that  the  structural  responses 
to  preselected  test  inputs  u1  are  recorded,  and 
optimally  interpolating  at  system  level  the  responses  to 
other  excitations  in  the  signal  class.  The  optimization 
is  formulated  as  a  minimization  of  the  maximum  distance 
between  the  interpolating  operator  and  any  candidate 
operator  that  matches  the  experimental  input-output 
signal  pairs.  If  the  system  data  are  not  accurate,  a 
weighted  minimization  that  does  not  require  exact 
matching  of  system  -esponses  can  also  be  useo. 

This  minimization  is  earned  out  in  a  Hilbert  space 
of  input-output  operators  equipped  with  a  weighted  "Fock 
space"  scalar  product  which  is  the  Hilbert  sum  of  the 
causal  L‘  scalar  products  of  the  Volterra  series  of  the 
operators  in  question.  A  different  proceoure  to 
calculate  the  coefficients  Oj  must  then  be  used.  The 
general  method  Is  discussed  in  the  papers  of  Dwyer 
(1986,  1986b)  and  de  Flgueiredo  and  Dwyer  (1980). 

The  HllDert  space  structure  for  m  inputs  (here  m  - 
3)  is  defined  as  follows:  let 

i  . .  1  e  ll . m)  and  let 

n 

ct,  t. . t  > 

h  1  n 


*  eT  exp{(t  -  t ^ ) A 1 3 ^  . .. 

...exp((t  .  -  t  ) A)  B  exp(t  A)Jx(O) 

n-i  n  i  n 


where  [3,*  |  3^\  . . .] 


whicn  means  also: 

•The  (I/O)  behavior  is  hignly  nonlinear. 

•The  system  is  high  dimensional  If  arising  from  Carieman 
linear) zation. 

•There  is  no  clean  ARMA  model  for  system  identification. 
Then,  by  using  optimal  interpolation  we  get: 

•Closed  form,  circui  t.  - lmpleaentable  bilinear 
approximations. 

•(I/O)  based  system  identi  f loation. 

•Tne  dimension  of  the  new  system  is  equal  to  the  number 
of  test  signals. 

New  rather  than  tolerate  the  time  delay  found  In 
tne  previous  techniques  of  estimation,  we  use  instead 
trie  method  of  ope-ator  spline  1  nterpolati  on  to  find  the 
deflect, on  amount  between  observations.  The  input 
Output  (I/O)  operator  V. 


These  are  the  Volterra  kernels  for  u,  (t.)  .. 
Then  1 1  1 


.  u,  (t  ). 
n  n 


<V  ,  V  ’  Ei  ...r,  f  f  ’... 

t  t  n  1,  i„  i,  i„  J° 


h  ,  ,  h  .  dt  ...dt, 

n.i  , . . .1  n, i , . .  .i  n  1 
1  n  t  n 


which  yields  the  reproducing  property 


<Vt.  Kt(u,  .)  >  -  V.  (u) 

The  Volterra  series  for  a  bilinear  system  will 
yield  a  bounded  norm  <Vt,  V^>  provided  tne  weights  r^ 


jn2»'"'T"'«o  jvste"  cen t»r  of  mass. 

■  i-3  '.re  cr.t  1  )  1 3dy  (  kxi  here)  mai-'r  Q*  2C2y 

cooreinaten  of  e**e'rai  forces  acting  on  the  centers  of 
:n«i5*  o!'  the  r*.  Aoc^^ap*? . 

**o  13  tr’’*  -“Kter-na:  force  acting  at  the  center  of 
tne  body  fixec  coorli.iara  ovjten.  U1  other  notations 
u ae<i  are  »:•*<£. 

***  ■i^q  ■/  “"o*  :  r*  ~‘'at  all  three  e^i;at.one  are 

:  nter** * : atec .  If  we  ^we  n^w  o °  1  ■/  t**e  vjhrat:or.ai 
equat.o ^,:f  .■notion,  anh  *«?».  the  rotation  arourcJ  a  Jin*;* 
axie,  uj-^k ,  anc  if  *-.h^  *',»''«,a*!cnai  accelerataOn  tern 
a0  ie  qur.3t:  t  ;ted  from  the  translational  equation,  then 

we  nave; 

My(C*2BJM)p*(KsOrJd2)JM)y(8*92J)Jn-f  ,-M(i.'rf*f0} 

wne-e  now  n  -  H^,  M  ;s  redefined  to  account  for 
contn i but i ons  due  to  translation  ana  every  third  row  or 
column  is  omitted  in  ail  matrices.  If  we  set  v  to  be  a 


yar^anie  sue n  that 
u  •<. iw.o*  ,2wi),  then  the  rotat:o 


becomes : 


i.C-CM  •  K  •  KM  and 
onal  equation  of  motion 


J*  <  C  *u-  J '  w*  ( K* u.  J  ♦u.,  « }  v-  f  *  Kn 

This  transformed  equation  can  also  be  written  in 
hi  .inear  form,  wmen  will  oe  used  frequently  in  the 
following  sections: 


n, !  . ;  -  M  (  .  -n) . 


hji.)  -  M  (.). 


let  I  iifi)  -  EC  •/  f  t )  V  (r)]  be  tne  covariance  matrix  o 
tne  sensors  for  v  1  andJlet  G4(t-t)  «  ECt‘(t)C(ti]  be 
tne  covariance  matrix  of  tne  actuator.  The  propagat.on 
error  matrix  is  defined  by  P,  wmen  satisfies  the 
following  differential  equation: 

p  ■  c ~  p  ♦  p[~  ♦  g( x jqci x ) T  -  p[|^;r  - 

"°x  -  ax  ax  x  ax  x 

X  X 

and  x  can  be  expressed  as  observed, 

.  *  *  •  * 

x  -  fix)  ♦  G(x)u  *  K(y-h(x)). 

y  -  h(x) 

where  :<  is  the  extended  Kalman  gain  of  the  observer  ana 
is  cefmed  as: 

K  -  P[ IV  R_1 
ax  x 

A  newly  developed  procedure  (Fadali,  Gardner  and  Dwyer. 
'966;  cased  on  a  change  of  vanaoies  in  preliminary 
studies  gave  us  a  better  time  of  computation  and 
therefore  a  more  reliacle  set  of  observed  data.  This 
procedure  ; 3  outlined  next. 


X*AX*3(X;u»o 


Feedback  Linearized  Procedure: 


a-  ^  :  i:: 

r  _  T  r  *  ■» 

L*<  J  i-u  . 

3(X)  -  [0]  CO  J  [0] 

and  JX1  *;  JX2 
0  -  Co i 

f ’-Kn 

X,  and  Xj  are_tne. vector  components  of  the  general  state 
vector  X  •  ( vi  “  ,  \i  ‘  i  ‘  . 

This  simplified  model,  insofar  as  the  links  are 
regarded  as  aass-iess,  exhibits  all  the  coupling  effects 
between  slewing  motion  and  vibrational  motion.  A 
distributed  model  'under  the  assumption  of  symmetry. |bout 
the  mass  center  also  yields  product  terms  between  3£  and 
structural  def ormati ons ,  and  can  be  found  in  Chapter  9 
of  tr.e  sea*  sy  Junkins  ana  Turner  (1986).  That  model  of 
a  symmetric  four  appendage  spacecraft  can  also  be  used 
to  illustrate  tne  procedures  being  developed  in  this 
study,  if  desired. 

ESTIMATION  AND  MOOELINC  OF  THE  DEFORMATION  STATE 

Estimation  of  the  State  bv  Means  of  observers: 

Extended  Kalman  filter  formulation: 

In  general,  when  we  deal  with  a  nonlinear  system  of 
which  the  state  variables  cannot  all  he  observed 
(corrupted  with  noise),  then  the  most  commonly  used 
method  of  filtering  or  smoothing  is  the  extended  Kalman 
filter  formulation.  Let  the  dynamical  system  be  modeled 
as : 

x  -  fix)  ♦  G(x)u  ♦  G(x)E. 


The  idea  is  to  change  the  state  conf igurati on  of  our 
original  system  which  has  the  particular  form  below: 

i,  -  VVX2 

y,  •  61  (x,  ♦  v, ) 

y2  -  h2(x2  *  v2) 

by  using  the  change  of 

I  * 

variables  x-|  *  *,  •  x2  *  F,  (x,)*2. 

* 

u’  -  x1  -  F2(x)u  ♦  f2(x)  and 

’  -1  1  -1 

y,  *  6,  Cy, ) .  y2  -  n2  (y2)  we  get 


Where  E '  •  F1 F^E  and  v.  -  F^v.,  so  that  the  covariance 
of  6’  is  approximated  &y  ' 

Q’  -  F,(x1)F2(x)QF2(x)  ‘F’/x1)T 

t 

whiie  that  for  v;  is  approximated  by 

Ri  *  VX1  )R1*r,<*>TF1 1*-, 


Then  the  new  error  covariance  matrix  propagation  is 
derived  from  the  following  differential  equation: 


[o;  [I]  [0]  [0]  to: 

P  -  [0 j  [0]  P  •  P  [I]  [0]  ♦  [I]  Q’([0]  Cl])  * 


y  •  h !  x  •  v)  . 


w’-e-r  . 1  is  tre  deterministic  (mean)  part  of  the 
input.  E  is  ze-c  mean  input  noise,  and  h  is  defined  in 
jur  esse  as : 


p  cn  :o:  r  '  in  co]  p 

Co]  Co]  [:3 

the  ot«e-veq  deformation  state  is  propagated  as  foilows: 
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Computed  torques  for  pointing  and  tracking  require  compensation  for 
slew-induced  structural,  forebody/aftbcdy,  or  optical  train  alignment  de¬ 
formations.  Thus  even  if  only  line-of-signt  variables  are  to  be  commanded 
yet  full  state  feedback  is  needed,  with  consequent  high  bandwidth  control 
requirements.  The  solution  investigated  here  is  to  decouple  the  unwanted 
deformation  state  by  feedforward  of  the  line-cf-sight  slew  dynamics  into 
the  deformation  controlforces  or  moments,  for  an  apparatus  consisting  of 
a  mirror  mounted  on  an  optical  bench,  that  is  itself  mounted  on  a  rotating 
table.  Adjustable  elastic  interfaces  are  used  to  model  slew-induced  de¬ 
formations  as  angular  differences  between  mirror  mounting,  optical  bench 
and  rate  table.  Low  bandwidth  control  with  fewer  actuators  than  degrees 
of  freedom  is  shown  to  be  possible,  by  correcting  the  computed  torques  so 


as  to  force  the  interstage  angular  differences  (standing  for  slew-induced 
deformations )  to  evolve  in  a  "slow  integral  manifolc  wherein  they  are  mod- 
e-s-  as  functions  of  the  mirror  pointing  angle.  Simultaneous  mirror  point¬ 


ing  and  independent  rate  table  pointing  is  also  shown  to  be  possible,  which 
represents  the  situation  of  pointing  an  instrument  elastically  mounted  on 
a  maneuvering  platform.  Comparisons  with  °ID  and  L^R  methods  are  also  made . 
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I.  Introduction 

Spacecraft  flexible  modes  have  often  challenged  automatic 
control  system  designers.  For  example,  unmodelled  antenna 
deformations  caused  Explorer  to  eventually  tumble  out  of  control. 
Often,  the  solution  used  for  such  problems  was  to  make  the  structure 
sufficiently  rigid  and/or  the  control  slow  enough  that  the  flexible 
modes  would  not  be  excited  by  the  controls  [Ref.  1],  However,  this 
option  may  not  be  available  in  the  future  for  some  spacecraft,  given 
the  current  interest  in  the  use  of  larger,  lightweight  space  structures 
with  correspondingly  lower  natural  frequencies.  The  presence  of 
flexible  modes  that  are  excited  by  the  controls  thus  poses  a  problem. 

The  solutions  to  this  problem  may  be  split  into  two  classes.  In 
the  first  class,  there  are  controls  available  to  be  dedicated  to  each  of 
the  flexible  modes.  In  the  second,  more  likely  case,  some  of  the 
modes  do  not  have  a  dedicated  controller.  This  paper  applies  a 
method  called  deformation  shaping  to  a  particular  problem  of  this 
latter  case.  This  method  was  adapted  by  Dr.  T.  Dwyer,  as  an 
extension  of  singular  perturbation  techniques,  such  as  by  Kokotovic 
[Ref.  2],  initially  used  in  control  of  robots  with  flexible  joints  by 
Spong  [Ref.  3].  The  method  modifies  slew  induced  deformations  to 
produce,  in  some  sense,  better  dynamics. 

A  variety  of  options  are  available  for  the  first  class  of  solutions. 
If  the  flexible  mode-pointing  control  interactions  are  ignored,  a 
simple  PID  control  of  the  modes  may  be  attempted,  but  the  results 
are  often  unsatisfactory.  A  somewhat  more  sophisticated  solution  is 
the  use  of  a  Linear  Quadratic  Regulator  (LQR)  design.  Another 
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possible  solution  is  to  rigidify  the  structure  with  some  application  of 
the  controls.  After  an  initial  transient,  the  structure  will  then  be 
effectively  rigid  and  have  no  flexible  mode-pointing  control 
interactions.  This  would  be  ideal,  but  the  type  and/or  number  of 
actuators  rarely  allow  this  control.  This  class  of  solutions  will  be 
used  as  a  basis  of  comparison  for  solutions  in  the  second  class,  for 
which  all  controllers  are  not  available. 

The  second  class  of  solutions  is  less  well  developed.  The 
problem  of  noncolocated  sensors  and  actuators  greatly  complicates 
matters.  PID  control  does  not  work,  and  rigidifying  control  does  not 
as  well.  It  is  possible  to  formulate  an  LQR  problem,  but  there  are 
some  drawbacks  to  this.  Many  other  solutions  are  currently 
proposed,  but  none  are  accepted  by  everyone  yet.  A  solution  for  a 
problem  in  which  all  controllers  are  not  available  will  be  done  using 
the  method  of  deformation  shaping.  This  will  then  be  compared  to 
control  solutions  for  the  same  problem  in  which  all  controllers  are 
available. 

In  addition,  there  are  additional  considerations  particular  to 
this  problem.  This  problem  arises  from  a  laboratory  model  to  test 
precision  pointing  control  methods.  Thus,  several  constraints  and 
additions  peculiar  to  this  setup  and  use  are  imposed.  These  include 
desired  performance,  actuator  and  sensor  dynamics,  and  equipment 
limitations. 

The  problem  posed  is  first  formulated  and  detailed.  Next,  the 
basic  theory  involved  is  discussed.  The  necessary  equations  are 
derived,  and  the  control  form  is  specified.  Then  the  control  is 
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designed.  The  effects  of  various  control  design  choices  are  explored, 
as  well  as  the  response  of  the  system  to  various  inputs.  Parameter 
sensitivity  and  noise  effects  are  briefly  discussed,  and  the  control 
solution  is  compared  to  various  other  solution  types.  The  results  are 
summarized,  as  well  as  possible  topics  for  future  examination. 
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II.  The  Problem 


2.1  Problem  Formulation 

It  is  desired  to  make  the  end  of  a  flexible  instrument  follow  a 
commanded  trajectory  as  quickly  and  accurately  as  possible.  The 
most  likely  real  world  counterpart  is  rapid  retargeting  slew 
command.  Another  possible  mission  is  tracking,  but  this  presents 
some  difficulties.  Two  scenarios  are  examined.  In  the  first  scenario, 
only  the  instrument  deformations  are  shaped  or  suppressed,  and  the 
vehicle  trajectory  can  be  commanded  separately  from  the  instrument 
trajectory.  For  the  second  scenario,  the  entire  vehicle  and 
instrument  system  has  its  deformations  shaped  by  the  control. 

Controls  for  the  first  scenario  are  derived,  applied,  and  their 
performance  analyzed.  This  is  then  done  for  the  second  scenario. 

Both  scenarios  then  have  their  performance  compared  to  various 
other  more  common  methods. 

2.2  Laboratory  Model 

The  laboratory  model  was  configured  to  represent  single  axis 
dynamics  of  a  multibody  spacecraft.  The  system  does  not  strictly 
resemble  the  dynamics  of  any  spacecraft,  but  can  be  used  to  make  a 
meaningful  comparison  between  control  methods. 

The  laboratory  model  consists  of  three  main  bodies  as  shown  in 
figure  1.  The  pointing  mirror  represents  the  end  of  a  flexible 
instrument.  The  optical  bench  represents  the  base  of  the  flexible 
instrument.  The  rate  table  may  be  considered  the  rest  of  the  vehicle, 
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such  as  propulsion  package,  or  a  connection  to  the  rest  of  the 
spacecraft. 

The  rate  table  and  the  optical  bench  are  isolated  from  one 
another  by  an  air  bearing,  with  springs  mounted  between  them  to 
provide  an  elastic  link.  Physical  considerations  limit  the  total  angle 
difference  between  the  rate  table  and  the  optical  bench  to  about  five 
degrees.  Two  Kimco  linear  actuators  mounted  between  the  two 
bodies  act  as  a  torque  actuator.  Another  actuator,  available  for 
control  and/or  disturbance  injection,  is  the  rate  table  itself. 

The  optical  bench  and  pointing  mirror  are  also  elastically 
linked  through  springs,  and  an  Aerotek  DC  motor  connects  the  two 
bodies,  providing  another  actuator. 

The  model's  springs  were  chosen  to  give  the  vehicle  "typical" 
spacecraft  natural  frequencies. [Ref.  4]  A  low  frequency  mode  at  .4 
Hz  simulates  very  flexible  components  such  as  solar  panels.  Another 
mode  at  1.5  Hz  represents  some  other  structural  flexibility. 

The  laboratory  model  thus  imposes  several  constraints  which 
are  not  present  in  the  real  system,  but  must  be  satisfied  in  the  lab. 
The  most  important  effects  come  from  the  angular  difference 
constraints  and  necessary  component  simplification. 

2.3  The  Mathematical  Model 

The  mathematical  model  is  an  idealization  of  the  laboratory 
model,  and  thus  only  approximates  the  laboratory  mode  It  is 
depicted  in  figure  2.  The  sensors  are  assumed  to  be  perfect,  and  the 
actuators  are  assumed  to  follow  standard  dynamics  with  certain 
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parameters,  as  detailed  below.  Each  body  is  assumed  to  be  rigid, 
connected  by  elastic  links.  The  links  are  assumed  linear,  and  time 
degradation  of  any  component  is  not  considered. 

The  actuators  have  several  constraints  imposed  on  them  as 
shown  in  figure  3.  There  are  physical  limitations  in  maximum  torque 
available. 

Figure  1 


Laboratory  Model 


Pointing  Mirror 


•Air  bearing  and 
elastic  link 


Actuator  for  T2 
and  elastic  link 


Optical  Bench 


Actuator  for  T 


Rate  Table  and 
Td  actuator 


Actuator  for  T, 
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bandwidth,  and  stroke.  The  problem  constraints  on  maximum  torque 
and  bandwidth  are  more  stringent  than  the  physical  limitations,  so 
the  physical  limitations  have  little  effect.  The  stroke,  however,  is  a 
major  physical  constraint,  and  is  the  most  significant  laboratory 
model  constraint.  The  motor  between  the  pointing  mirror  and  optical 
bench  has  a  range  of  forty-five  degrees.  Since  the  maneuvers 
simulated  will  be  less  than  or  equal  to  twenty  degrees,  this 
constraint  has  little  effect  as  long  as  there  is  little  overshoot.  Due  to 
the  linear,  instead  of  rotational,  nature  of  the  Kimco  actuators 
providing  Tl5  there  is  a  maximum  permitted  angular  difference  of 
about  five  degrees  between  the  rate  table  and  optical  bench.  This 
greatly  limits  the  allowable  controls. 

The  control  torques  are  assumed  to  be  produced  by  standard 
PM  DC  motors,  in  linear  or  rotational  form.  These  motors  also  have 
controllers  so  that  they  produce  constant  torque  output  for  a 
constant  input  signal.  Otherwise,  the  steady  state  output  would  be 
constant  rotational  or  linear  speed,  and  zero  torque.  The  resulting 
transfer  functions  for  the  compensated  actuators  are 

_  100* 

Tdccmm^s)  s2+207ts+i00*2 

Acmufs)  _ _ 2957 6 _ 

Tia*^s)  s2+219.3s+29576 


[1] 
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The  details  of  how  these  were  obtained  are  in  Appendix  A. 
These  actuators  have  only  been  compensated  to  produce  a  constant 
output  torque  given  a  constant  input.  This  compensation  does  not 
implement  any  control  scheme  on  the  model. 


2.4  Equations  of  Motion 

The  equations  of  motion  of  this  system  are 


1 20  2  +  k  2(9  2*8 1)  -  T2 


[4] 


I  j9 1  +k  2(9^82)  +k  i(9j-9t)  =Tj  -  T2 


[5] 


I-rOj  +  k  1(9t-01)  =  Td  -  Tj 


[6] 


where 

9t  =  angle  of  rate  table  with  respect  to  fixed  point 
9i  =  angle  of  optical  bench  with  respect  to  fixed  point 
02  =  angle  of  pointing  mirror  with  respect  to  fixed  point 
It  =  moment  of  inertia  of  rate  table  about  vertical  axis=  .417  Nmsec2 
Ii=moment  of  inertia  of  optical  bench  about  vertical  axis 
=  1.627  Nmsec2 

12=  moment  of  inertia  of  pointing  mirror  about  vertical  axis 
=  .863  Nmsec2 
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ki  =  spring  constant  for  link  between  rate  table  and  optical 
bench=  2.27  Nm/rad 

k2  =  spring  constant  for  link  between  optical  bench  and 
pointing  mirror=  49.8  Nm/rad 
Tq  =  disturbance  torque  due  vehicle  maneuvering  torque 
Ti  =  control  torque  1 
T2=  control  torque  2 

These  equations  can  be  expressed  in  matrix  form  too,  but  that 
is  used  only  for  Scenario  B  (below). 

The  system,  actuators,  and  controllers  are  connected  as  in  the 
matrix  block  diagram  shown  in  figure  4. 


Figure  4 

Commanded 

Trajectory  Output 


III.  Theory 


3.1  Introduction  to  Theory 

The  equations  of  motion  can  be  transformed  into  the  singular 
perturbation  equations  of  motion.  They  are  called  this  because  some 
of  the  variables  represent  parasitic  perturbations  of  the  pointing 
dynamics.  There  are  different  possible  sets  of  these  singular 
perturbation  variables.  However,  there  are  two  best  choices. for  this 
problem,  depending  on  what  dynamics  or  responses  are  desired  and 
what  controls  are  available.  Two  scenarios  (i.e.  choices  of 
perturbation  variables)  are  considered.  The  first  one  consists  of  the 
case  where  only  the  instrument  (i.e.  between  the  mirror  and  optical 
bench)  deformation  is  considered  a  perturbation  variable.  The 
second  scenario  is  the  case  when  both  instrument  and  vehicle 
mounting  (i.e.  between  the  optical  bench  and  rate  table) 
deformations  are  considered  perturbation  variables.  The  first 
scenario  allows  the  instrument  to  slew  and  point  in  a  given  manner 
while  the  vehicle  may  be  moving  in  some  other  manner.  The  second 
scenario  can  be  interpreted  as  making  the  instrument  slew  and  point 
when  the  vehicle  orientation  does  not  matter. 

3.2  Scenario  A  Perturbation  Equations  of  Motion 

This  scenario  is  simpler  algebraically  since  there  is  only  one 
perturbation  variable.  It  is  considered  first  since  the  derivation  is 
easier  to  follow  and  less  cumbersome. 
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For  the  first  scenario  the  deformation  variable  choice  used  is 


z  =  k2(0i-02)  [7] 

with  the  definitions: 

4>  =  (02  -  0T)  [8] 

£  =  1/k  2  [9] 

The  singular  perturbation  equations  of  motion  are  then 

•• 

I  202  -  Z  =  T2  pgj 


ez  +  (J_  +  J_)z  +  £klz  +  kl *  =  H.  (-L  +  X)t2 
Mi  I2  Ii  Ii  Ii  vIi  12 


[11] 


I  i+k  i<j>  +ek  iZ  [22] 

The  variable  z  is  proportional  to  the  deformation  between  top  and 
bottom  of  the  instrument  and  the  variable  <|>  is  the  coupling  term 
between  the  instrument  dynamics  [10], [11]  and  the  vehicle  dynamics 
[12]. 


3.3  The  Integral  Manifold 

The  integral  manifold  approach  and  its  applications  are  more 
rigorously  discussed  in  [Ref  5,6].  This  is  a  brief  overview  of  useful 
ideas. 

The  integral  (or  slow)  manifold  is  a  certain  lower  dimensional 
manifold  of  the  system  dynamics  which  relates  the  system  states  and 
depends  upon  the  controls  and  the  singular  perturbation.  For  some 
appropriate  choice  of  controls,  if  the  manifold  is  reached  then  the 
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system  will  remain  on  the  manifold.  The  appropriate  controls  can  be 
found  by  solving  a  PDE  for  the  manifold. 

The  perturbation  variable  can  be  thought  of  as  the  sum  of  two 
terms;  a  term  on  the  manifold,  and  a  fast  remainder  term. 

z  =  zm  +  z{  [13] 

The  faster  the  remainder  term  decays  to  zero  the  better,  since  then 
the  integral  manifold  determines  the  dynamics.  In  general,  the  fast 
term  often  decays  due  to  damping  in  the  system.  However,  for  this 
problem  the  damping  must  be  added.  This  is  done  by  a  fast  control 
that  is  detailed  below. 


3.4  Time  Scale  Separation 

In  this  problem  two  different  processes  are  occurring.  First, 
the  dynamics  are  quickly  decaying  to  the  integral  manifold 
dynamics.  Meanwhile,  the  manifold  dynamics  are  "slowly"  reaching 
the  desired  dynamics,  as  explained  below.  This  leads  to  a  separation 
of  variables  based  on  their  time  scale.  In  the  fast  time  scale,  the 
"slow"  variables  are  changing  so  slowly  that  they  are  approximately 
constant  and  have  little  noticeable  effect  if  the  "fast"  dynamics  are 
fast  enough.  At  most,  the  fast  dynamics  will  see  a  constant 
disturbance.  Looking  at  the  slow  time  scale,  if  the  "fast"  variables 
decay  fast  enough,  the  most  effect  they  have  on  the  "slow"  variables 
is  a  short,  transient  disturbance  input.  When  considering  the 
variables  in  the  two  time  scales  to  be  essentially  independent, 
equation  [13]  can  be  used  to  rewrite  [10],  [11],  and  [12]  as 


[14] 


e[zf  +  ( 


*20  -  ZlM  ~  T2,i0*  (+zf) 


[15] 


«m  +  (S^J±L+J_)Zim  +  M  =  -  ( -L  +  -L)T2„„ 

M  12  1 1  II  12 


[16] 
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ft  “IV  c^l_  Ulow 
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[17] 


where  A  =  a  small  disturbance  input,  To  =  Tdsiow,  T2  =  Tssiow,  and 


T 1  —  Tisiow  +  Tifast 


[18] 


since  Ti  is  assumed  to  be  the  only  control  with  high  enough 
bandwidth  to  have  a  fast  control  term.  The  Zf  terms  in  [15]  and  [17] 
are  transient  disturbance  terms  which  affect  the  slow  dynamics  and 
their  impact  must  be  minimized  by  the  slow  control.  In  addition, 

[14]  gives  the  dynamics  of  the  fast  variable.  This  equation  is  used  to 
design  the  fast  control  Tifast  to  drive  Zf  to  zero  as  quickly  as  possible. 

3.5  Fast  Control 

It  is  desirable  to  use  feedback  to  generate  a  Tifa$t  to  drive  Zf  to 
zero.  There  is  a  choice,  however,  of  whether  to  feed  back  only  the 
fast  part  of  z  (zf)  or  all  of  z.  Since  a  high  pass  filter  would  probably 
be  needed  to  measure  only  Zf,  all  of  z  will  be  used  as  feedback. 
Therefore,  fast  and  slow  terms  will  arise  from  this  feedback.  Only 
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the  fast  terms  will  affect  the  fast  dynamics,  as  discussed  above.  The 
slow  terms  will  affect  the  slow  or  manifold  dynamics.  This  control  is 
called  the  fast  control  even  though  it  affects  the  slow  dynamics, 
because  it  is  the  only  control  that  is  used  for  control  of  the  fast 
dynamics.  The  sensor  dynamics  of  this  feedback  are  neglected. 

There  are  many  possible  choices  for  the  control  form  but  a 
proportional-derivative  (PD)  feedback  controller  will  be  used 
because  it  is  the  simplest  that  can  do  what  is  required.  The  control  is 
of  the  form 


Tj  =  Tj  -  e(aji  +  a qz) 

so  that 

Tito  =  *(Mf  +  Vf) 

TUiow  =  Ti  ’  e(ai*iM  +  Vim) 


[19] 

[20] 
[21] 


where  Tj  tilda  is  used  for  slow  control.  Then  using  [20]  the 
compensated  fast  dynamics  are 


1 1  1 1  e  1  i  1 2 


[22] 


where  A  is  a  small  disturbance  input 

The  gains  ai  and  ao  may  now  be  chosen  for  the  desired  fast 
dynamics.  For  example,  the  fast  controller  is  chosen  to  make  the  Zf 
dynamics  behave  as  a  system  with  damping  ratio  z=  .7071  and 
damped  natural  frequency  C  as  below,  where  Uf=A/£. 


zf  +  2ozf  +  2c  Zf  =  Uf 


[23] 
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This  occurs  when  the  gains  are  chosen  as 


Since  £  is  small,  Uf  is  possibly  a  significant  disturbance  input. 
Thus,  for  nonzero  A  there  may  be  a  significant  steady  state  error  in  Zf 
for  some  situations  using  the  PD  control.  This  error  did  not  destroy 
the  performance  or  stability  of  the  control,  but  its  effect,  if  any,  is  not 
analyzed  in  this  paper. 


3.6  Singular  Perturbation  Expansion 

The  equations  describing  the  slow  dynamics,  including  the  slow 
feedback  component  of  the  fast  control  but  neglecting  the  fast 
transient  disturbances  are 


I292  ’zIM  =  T2  [26] 

eziM  +  ^-^ziM  +  (g^±l_  +  -L-  +  ^-)z1M  +  =  + 

Ii  v  Ii  h  Ii  Ii  It  U  W  [27] 


The  vehicle  dynamics  are 


0  k  1^  /  83  1  \  z  £(a0  l)  z  _  Z°  li 

T’  It  "v  I]  Ii  It  '  It 

[28] 

To  solve  [26]  and  [27],  zim  must  be  found. 


One  method  of  solving  for  zim  involves  expanding  zim,  Ti,  and 
T2  in  power  series  of  £. 

2 


zIM  =  z0  +ezl  +e  z2  +  •  •  • 

[29] 

Ti  =  Tio+eTn  +e  T12  +. . 

[30] 

2 

T2  =  T2o  +  eT21  +e  T22  +  .  •  * 

[31] 

Substituting  these  into  [26]  and  [27],  and  equating 

power  in  £  results  in: 

terms  of  equal 

0  - 

For  e  :  1 2^2 '  zo  =  ^20 

[32] 

(^+h)zo  +  I^=7r-(i1r+i2)T20 

[33] 

1 

For  e  :  zj  =  T2j 

[34] 

Zo+  jL-ZQ  +  (7^  +  rL)Z0  +  (^  +  ^~)zl  -  •  (^~  +  /“)T21 

Ii  vIi  Ii  Ii  W  Ii  vIi  W  [35] 
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[36] 


2 

For  e  :  z2  =  T22 


‘i\+ 


[37] 


etc. 

For  the  vehicle  dynamics,  no  singular  perturbation  expansions  are 
used,  since  the  effect  of  vehicle  motion  is  regarded  only  as  an 
exogenous  input  to  the  instrument  slow  dynamics.  These  equations 
can  be  used  to  determine  the  desired  instrument  slow  controls,  then 
the  vehicle  controls. 

A  Rigidifving  or  Deformation  Suppression  control  can  be  found 
for  the  instrument  if  T2  is  not  equal  to  zero.  This  rigidifying  control 
must  drive  the  instrument  deformation  (zim)  in  a  short  time  to  zero 
and  keep  it  so.  This  means  that  the  manifold  desired  is  zim=zo  +  £  zi  + 
.  .  .  =0.  After  decay  of  the  fast  dynamics,  this  manifold  will  be 
reached  and  the  instrument  will  act  as  if  it  were  rigid. 

An  obvious  solution  to  this  is  zo=zi=  .  .  .  =0,  which  forces  setting 
Tu=T2i=0  for  i=l,2,3,...  ;indeed,  for  this  solution,  [32]  thru  [35] 
become: 


For  e°:  1202  =  T20 


[38] 


0  = 


fl  lL  It  -uki* 

—  +  — -rr2o  -  — T10  +— $ 

Im  12J  M  M 


[39] 
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For  e1:  0  =  T21 


[40] 


[41] 


etc. 

From  these  equations,  one  can  design  controllers  using  any  means  for 
desired  performance,  robustness,  etc..  This  is  done  in  Appendix  C. 
However,  deformation  suppression  can  be  done  only  when  there  are 
as  many  cortrols  as  modes:  all  three  (To,  Ti,  T2)  controls  must  be 
used. 

For  a  Deformation  Shaping  control,  it  is  not  desired  to  drive  the 
deformations  to  zero,  but  rather  to  shape  and  use  them.  For 
example,  if  T2  is  not  available  to  directly  affect  the  instrument 
deformations,  the  deformations  (z)  can  be  shaped  to  be  expressible  in 
terms  of  the  pointing  dynamics  ©2  and  achieve  the  desired  response. 
Since  deformations  are  needed  to  exist  after  the  fast  dynamics  have 
decayed,  zim  is  not  equal  to  zero.  However,  by  examining  the 
equations  [32-37],  one  notices  that  with  zj=0  and  Ti,(i+i)=0  (for  i>=l), 
a  solution  can  be  found  for  z 0,  T10,  Tj  1 .  The  equations  are  then 


1 2©2=z0 


[42] 


U-  +  I_L  +  !£L*aIlflL 

iii  hr  h  Ii 


[43] 
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[44] 


3.7  Slow  Control  Design 

Using  [24], [25], [30], [42]. [43],  and  [44] 
frequency  domain) 

Ti(s)  =G1l(s)©2(s)+M(s) 

where 


Gi(s)  = 


Jll/ _ l _ \ 

Iih^s2  (s2+  2as  +  2a2)/ 


we  can  write  (in  the 


[45] 


[46] 


To  exactly  model  and  control  the  dynamics,  up  to  fourth 
derivatives  (jerk  rate)  of  02  would  be  needed.  Since  these  are 
unlikely  to  be  available  as  feedback,  a  form  can  be  found  only 
requiring  higher  derivatives  of  a  commanded  trajectory.  This  is  done 
by  using  the  model 

?,(s)  =G;‘(s)s](s)  +k,<Ks)  +H1(s)(e](s)-6j(s))  [47] 

where  Hi(s)  is  a  controller  designed  below  to  make  ©2  follow  its 
commanded  trajectory.  This  model  uses  commanded  feed  foward  of 
GrI(s)02*(s)  and  the  decoupling  term  ki<[>. 
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In  a  fashion  similar  to  that  for  Ti(s),  Td(s)  can  be  expressed  as 


Td(s)  -  I-i$  e^s) 


-i 


^{ais  +(ao+ki)s  h  Gi  (s)j©2(s) 

fMa^+ao+kJ  s2G,(s)  - 1  !h,(s)(©2(s)-©2(s)) 
k2  I 

+  Hd  (s)(©J  (s)-St  (s)) 


[48] 


where  Hd(s)  is  a  controller  designed  below  to  make  ©j  follow  its 
commanded  trajectory.  One  major  difference  between  the  dynamic 
models  is  that  the  model  [47]  was  free  to  be  chosen,  but  once  this 
model  was  picked  and  the  control  designed  using  [47],  the  model  [48] 
for  Td  was  completely  specified  except  for  Hd(s). 

The  slow  controllers  may  be  designed  various  ways.  The  use  of 
classical  SISO  (single  input  single  output)  design  can  now  be  done 
with  our  new  system  if  care  is  taken.  This  will  be  done  for 
illustrative  purposes,  but  undoubtedly  a  better  control  design  could 
be  found. 

It  is  desired  to  have  the  slow  control  drive  the  actual  trajectory 
to  the  commanded  trajectory.  The  slow  control  is  designed  to  drive 
this  enror  to  zero.  This  is  not  to  be  confused  with  the  fast  control 
driving  the  off-manifold  dynamics  to  zero.  The  deformation 
dynamics  (not  error  dynamics)  resulting  from  the  design  of  the  slow 
control  are  the  slow  manifold. 

The  model  [47]  results  in  the  transfer  function  form  given  in 
figure  5. 
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Figure  5 


Now  a  simple  regulator  design  is  done  to  find  H^s).  It  was  found 
that  the  simplest  form  able  to  stabilize  the  system  was 


H^s)  = 


2 

I  !l2K(s  +m1s+m0) 
k  2  (s+b) 


[49] 


Once  this  form  was  chosen,  the  parameters  were  then  selected.  The 
final  design  chosen  consisted  of  b=mi=C,  mo=a2/4.  This  corresponds 
to  a  controller  with  two  zeros  at  -C/2  and  a  pole  at  -a.  K  was  chosen 
from  the  root  locus  (see  figure  6)  for  good  closed  loop  pole  locations. 
The  choices  used  for  K  are  detailed  in  Table  2.  These  situations  in 
Table  2  will  be  explained  in  greater  detail  below.  In  addition,  the 
effect  of  K  on  the  time  scale  separation  will  also  be  discussed  below. 

The  design  of  Hd(s)  was  done  in  a  similar  manner.  The  same 
block  diagram  as  figure  5  is  used,  except  the  plant  was 
Gd(s)=It(s)/s2  and  the  controller  Hd(s)  was  found  to  be: 


Hd(s)  =  2Itcd(s  +  Sa) 


[50] 


23 


Root  Locus 


Table  2 


Choices  used  for  K 


Situation 

Choice  for  K 

Low  BW 

50 

High  BW 

1429 

Low  BW,  larger  separation 

29 

High  BW,  larger  separation 

715 

The  parameter  cd  was  found  to  give  acceptable  performance  when  it 
equaled  about  .28  c,  and  good  performance  when  it  equaled  about  a 
Undoubtedly,  a  better  controller  could  be  found,  but  this  one 
sufficed. 

After  the  control  design  is  done,  the  resulting  controls  are: 

Ti  =  a1(02*@i)+  ao(02-©i)  + — (@2  +  2<j@2  +  2o2©2) 

,  .  \ 

4- IlIllL  (©2  -  02  +  (m  i -b )  (©2-02)  +  yj  +  k i4> 

k2  [51] 

Td  =  *^2  (©r  +  2cd  (©t  -©t)  +  2cd2  (©t  -©t)) 

^2 

-  ^2-^-(a1©2  +  (ki+  ao)  ©2)  -  (©2  -©2  +  c0(®2  -©2)  +  yj 

k2dt  k2 

*  1  (©2- ©2) +  y2  +  >^3) 

k2  [52] 
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where  yj,  yi,  and  y3  are  found  from 


yi=  -by!  +  Cj(02  -  ©2) 


y2=  -by2  +c2(©2-©2 


1=  -  2cy3  -  2a2y3  +  c3(©2  -  ©2)  +  cjei  *  ©2) 


and  cq,  ci,  cz,  C3,  and  C4  are  detailed  in  Appendix  B. 


3.8  Scenario  B  Derivation 

The  derivation  for  the  scenario  in  which  the  deformations  of 
the  entire  system  are  shaped  is  very  similar  to  the  derivation  for  the 
previous  scenario.  In  this  case,  however,  there  are  two  perturbation 
variables  defined(A  perturbation  vector). 


zA  k  i(9 1  -  ©  -jO 


z2j  ( k2(e2-e i> 


The  resulting  singular  perturbation  equations  of  motion  are 


1 2®  2  +z2  =  t2 
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dTz,  +  [lifij  z,  ■  z2=  killfit )  T,  -  tLT2  ■  TD 

1 1  /  M  ’  M  I  II 


where  5=k i/k2  and  e=  1  /k i  with  ki<k2.  Using  the  fast  control 


Tiful  =  {kia01  k2a02]  (01'0t)  -[ana12]  (01'0t) 

.  (02-0l)  J  L  (02-01)  J  [60] 


results  in  the  fast  dynamics  having  four  poles  at  -w.  If  aoi,  ao2,  an, 
and  a! 2  are  chosen  as  follows: 


„  _  w  hhh 

a  o  i - 1 

k1k2(I1+I2+IT) 


a  1 1  — 


4  w  1 1 1 2I  t 
k2(I  i+I2+Ij) 


i  ,  I  i  6w2T  ,  w  I  iI2(I  i+It) 
a02  =  1  +~ - ; — - 


I  2  2 


^2^  1+I2+^t) 


a  4w  I.IzOi+It)  ,2wI 
k  2<I  i+Iz+It) 
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The  resulting  slow  dynamics  are  again  used  to  solve  for  the  slow 
manifold  through  singular  perturbation  expansions.  The  expansions 
used  are 


2 


ZUd  -  Zo  +  £3 1  +  e  Z2  +  •  •  • 

[65] 

2 

Tj  =  T10+eT11  +  e  T12  +  . . . 

[66] 

2 

=  T20  'i-  2 1  +  e  ^22  +  •  •  • 

[67] 

2 

Td  =  Tqq  +  eTdi  +  e  Tq2  +  •  •  • 

[681 

Substituting  these  into  the  slow  dynamics  equations 

equal  powers  in  £  results  in  the  equations 

and  equating 

•• 

1 202  +[0  1  to  =  T  20 

[69] 

U 

II 


(Ii+lT)(l+a01) 

-hO+aoi) 


It 


I  i+IT 

-I2 


(Ii+IT)a02-lT 

Ii+I2(l*ao2) 


10 


-IT 
1 1+I2 
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,0 


jzo 

^DO 

[70] 

[71] 

[0  i]zi  =T21 


IT  0 

(I  i+Ij)a  1  j 

(1 1+Ix)5a  12 

0  51 2 

so  + 

"  I  2a  1 1 

> 

-I25aI2 

(I  l+ll)(^+a0i) 

(I  i+1 2)a 02  *  ^ 

+  — 
Ii 

- 

I2(l+a0i) 

I  i+I2(  1  *a 02) 

_  1 

I  !+IT 

Tn  +  — 

•It 

T  2 1  - 

V 

Ii 

.  . 

h\ 

1 1+I2_ 

Oj 

[72] 


If  Td,  Ti,  and  T2  were  all  available,  a  rigidifying  control  could 
be  found  using  a  process  identical  that  was  used  for  the  previous 
scenario.  However,  only  the  deformation  shaping  case  for  T2=0  will 
be  examined  for  this  scenario.  With  Ti=0  a  solution  can  be  found  is 
before  with  Zi=TD,(i+i)=Ti,(i+i)=0  for  i>=l.  The  resulting  equations  can 
be  written  as 


-  [0  l]zo  — 12®  2 


II 


(I  i+IT)(l+aoi)  (I  i+Ix)ao2"^T 

-I2(l+a<)i)  Ii+I2O*a02) 

"M  -1*/ 


10 


J 

ojj-co 


IT  0 

0  5I2 


H 


(Ij+IxJan  (I  i+Ix)^a  1 2 

[  * 1  2a  1 1  ‘l25*12 


%0 


•[73] 


[74] 


[75] 
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Proceeding  as  in  Scenario  A,  [74]  is  used  to  substitute  in  for  zo 
into  [73]  and  [75].  Choosing  Tio=0  (otherwise  free)  ,  [75]  can  be 
solved  to  find  Tn,  Too,  and  Tdi-  The  resulting  slow  dynamics  are: 

Gd(s)©2(s)  =Td  [76] 


G  i(s)©2  (s)  =T i  [77] 

For  the  fast  control  gains  used  in  [61]  -  [64],  the  expressions  for  Gd(s) 
and  Gi(s)  are: 


Gd(s)  = 


1 

(ii  +  I2  +  It) 

s2  +  1] 
iw2  1 

s2 

[78] 


Gi(s)  = 


_ 1 _ 

1 1 12  (  s  -  20w)  s3 


Again,  a  control  is  sought  of  the  form: 
Td(s)  =  Gd1(s)©2  +  Hd(s)  (©2 -02) 


[79] 


[80] 


Unlike  Scenario  A,  the  use  of  this  control  law  completely  determines 
the  other  control  law  as: 


Ti(s)  =  G\1(s)Q*2  +  G‘11(s)Gd(s)Hd(s)  (©*2  -  ©2) 


[81] 
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The  slow  control  design  used  in  Scenario  B  differs  from 
Scenario  A.  Instead  of  using  a  root  locus,  the  closed  loop  poles  of  the 
02-0;*  error  dynamics  were  placed.  The  slow  control  design  chosen 
placed  all  five  poles  on  the  real  axis  at  -X.  The  form  of  Hd(s)  was 
chosen  as  the  same  form  as  in  [49].  To  achieve  this,  the  controller 
parameter  values  were  b=  5X,  mo=  X/40,  and 


m,  = 


-L  +  -L 

64  10 


The  parameter  1/X  represents  the  time  constant  of  the  error 
dynamics.  However,  in  order  to  place  the  poles  in  this  manner  X  was 
found  to  be  related  to  w  by 
X-  w 

V6Cf  [83] 

Thus,  the  time  scale  separation  was  fixed  at  approximately  7.75  and 
could  not  be  adjusted  as  in  Scenario  A  without  redesigning  the  slow 
control.  Consequently,  the  time  scale  separation  was  explicitly  stated 
but  for  a  given  fast  dynamics  speed  w,  the  slow  (error)  dynamics 
were  much  slower  (at  least  twice  as  slow  as  Scenario  A  slow 
dynamics).  This  caused  the  time  response  for  Scenario  B  to  be  much 
worse  than  the  other  methods.  With  a  better  slow  control  design  this 
method  would  perform  about  as  well  as  Scenario  A  deformation 
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shaping.  A  lesson  learned  from  this  is  that  the  slow  control  design 
greatly  influences  the  deformation  shaping  performance. 

The  controls  resulting  from  the  design  can  be  rewritten  as 


Tj  =  Tifut  +  LlL.  A —  (@2  +  C5  ©2)  +  40X3  (©2  -  ©2)) 
k2  \dt2  I 

+  - - — \40X  ((cj+mj+b)  (©2  ■  ©2)  +  y4  +  yj)} 

k2  [84] 


Td  =  (Ii  +  I2+It)\-^—  ^ —  +  ©2  +  4x(©2  -  ©2)/ 


dt  \10X 


4X(Ii+I2+It)  (cq  (©2  -  @2)  + 


where  y4,  y 5,  and  y6  are  found  from  solvrn^ 


y4=  -by4  +  c6  (©2  -  ©2) 

[86] 

y5=  -10X2  y5  +  c7  (©2  -  ©2)  +  cs  (©2  -  ©2) 

[87] 

y6=  -by6  +  ci  (©2  -  ©2) 

[88] 

and  ci,  C2,  C5,  eg,  C7  and  cs  are  functions  of  various  system  parameters 
as  detailed  in  Appendix  B.  These  controls  result  in  a  non-minimum 
phase  controller  with  one  zero  at  +.233X. 


IV.  Simulation 


4. 1  Simulation  Details 

The  simulation  was  done  on  a  CDC  mainframe  computer  system. 
A  simulation  package  called  Eclectic  Simulation  Package  (ESP), 
developed  at  The  Aerospace  Corporation,  was  used.  Various  ESP 
commands  were  converted  by  the  ESP  precompiler  into  Fortran  V 
source  code,  and  then  executed.  The  dynamics  were  all  simulated  in 
state  space  form  with  integration  performed  by  a  Runge-Kutta 
Fourth  Order  fixed  step  algorithm.  The  fixed  time  step  used  was  .001 
seconds.  The  output  was  produced  on  an  IBM  3820  printer.  An 
example  listing  of  the  Fortran  V  program  is  listed  in  Appendix  C. 

4.2  Results  for  Scenario  A  Deformation  Shaping 

The  single  deformation  shaping  case  is  examined  with  two 
types  of  commanded  trajectories  02*.  These  are 

02*  =  A(1  -  e-<A)  [89] 

62*  =  Bsin(wt)  [90] 

The  commanded  trajectories  0j*  are  usually  equal  to  02*>  and  A=.087, 
B=.043,  t=.5,  w=2ji  unless  otherwise  specified.  The  variable  t  is  time 
in  seconds,  A  and  B  are  amplitudes  in  radians,  t  is  a  time  constant  in 
seconds,  and  w  is  frequency  in  rad/sec. 

Both  the  slow  and  fast  control  bandwidth  can  be  varied  by  the 
choice  for  a,  the  damped  natural  frequency  of  the  fast  dynamics.  The 
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slow  control  bandwidth  can  be  adjusted  through  a  parameter  K,  a 
gain  in  the  slow  controller.  This  K  also  affects  the  time  scale 
separation. 

The  system  response  and  performance  varied  greatly 
depending  on  what  bandwidth  was  chosen.  The  "low"  bandwidth 
case  was  for  a  =  ;t,  with  K  values  of  4  and  7.  The  "high"  bandwidth 
case  was  with  a  =  3tc,  with  K  =100  or  K  =  200.  The  K  =  4  and  K  =  100 
runs  represent  time  scale  separations  of  about  a  factor  of  three;  i.e. 
the  fast  dynamics  are  three  times  as  fast  as  the  error  dynamics.  The 
K  =  7  and  K  =  200  cases  represent  the  fast  dynamics  being  about 
twice  as  fast  as  the  error  dynamics. 

For  an  exponential  command  trajectory  as  defined  above  for  82* 
and  0t*.  comparisons  can  be  made  between  different  controller 
bandwidths  and  different  time  scale  separations  for  the  runs 
summarized  in  Table  2.  It  is  evident  that  the  required  control  effort 
(peak  torque)  increases  dramatically  for  a  controller  bandwidth 
increase.  However,  when  the  time  scales  are  more  widely  separated, 
the  maximum  torque  increase  is  not  quite  as  dramatic.  Comparing 
these  torque  outputs  with  the  constraints  from  figure  3,  one  notices 
that  the  high  BW  controllers  require  too  much  torque  for  the  lab  (the 
high  BW  three  times  separation  case  might  be  possible,  but  it  is 
pushing  the  limit  of  actuator  capabilities). 
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Table  2 

Maximum  Actual  Output  Torque 
for  Exponential  Commanded  Trajectory 


Torque 

2X  time 

scaling 

3X  time 

scaling 

Low  BW 

High  BW 

Low  BW 

High  BW 

Td 

2.1  Nm 

24  Nm 

1.4  Nm 

9  Nm 

T 

l 

5.2  Nm 

115  Nm 

2.1  Nm 

11.5  Nm 

Notes 

1.  Low  bandwidth  controller  uses  o=x 

2.  High  bandwidth  controller  uses  c=  3jr 

3.  For  2X  time  scale  separation,  K=4  (low  BW),  K=100  (high  BW) 

4.  For  3X  time  scale  separation,  K=7  (low  BW),  K=100  (high  BW) 

5.  All  initial  conditions  equal  to  zero 

Similar  runs  were  made  for  the  sinusoidal  commanded 
trajectory  and  the  control  torques  are  summarized  in  Table  3.  As 
before,  the  required  control  effort  was  dramatically  larger  for  the 
higher  BW  controllers,  and  required  too  much  torque  given  the  limits 
of  the  lab  equipment. 
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I 

I 

I 


Actual  Output  Torque  (Nm) 

For  Sinusoidal  Commanded  Trajectory 


Control 

2X  time  scaling 

3X  time  scaling 

Low  BW 

High  BW 

Low  BW 

High  BW 

T  (max) 

D 

3.5  Nm 

40  Nm 

3.25  Nm 

16  Nm 

T  (after 

D 

transient) 

3  Nm 

3  Nm 

3  Nm 

3  Nm 

T  (max) 
l 

5  Nm 

190  Nm 

4  Nm 

45  Nm 

T  (after 
transient) 

2.5  Nm 

2.5  Nm 

2.5  Nm 

2.5  Nm 

Notes 

1.  <j=jc  for  low  BW  control 

2.  c=  3k  for  high  BW  control 

3.  For  2X  time  scale  separation  K=4  (low  BW),  K=100  (high  BW) 

4.  For  3X  time  scale  separation  K=7  (low  BW),  K=200  (high  BW) 

5.  All  initial  conditions  equal  to  zero 
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The  higher  BW  controllers  cost  a  lot  more  control  effort,  but 
they  gave  a  faster  response,  as  expected.  The  approximate  2% 
settling  times  for  the  exponential  and  sinusoidal  commanded 
trajectories  were 

Table  4 


Deformation  Shaping 
Time  Response 


Case 

2%  Settling 
time  (sec) 

low  BW,  2X  sep. 

2 

high  BW,  2X  sep. 

0.5 

low  BW,  3X  sep. 

4 

high  BW,  3X  sep. 

1.5 

One  reason  the  response  times  are  longer  for  the  larger 
separation  cases  is  that  the  fast  dynamics  are  the  same  for  both  time 
separations,  so  a  larger  separation  means  slower  error  dynamics. 

The  time  response  benefits  of  a  higher  BW  control  are  evident,  but 
then  so  are  the  control  effort  costs. 

The  deformation  shapes  are  shown  in  figures  7  and  8  for  the 
exponential  and  sinusoidal  commanded  trajectories,  respectively. 

Both  are  for  g=3.6k,K=1,  c d=ji,  and  zero  initial  conditions.  Notice  that 
the  deformations  never  die  out  for  the  sinusoidal  case,  but  instead 
make  02  follow  the  commanded  trajectory. 
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Deformation  02  *  ©j 


The  effect  of  nonzero  initial  conditions  upon  the  control  was 
examined.  In  general,  the  initial  conditions  could  help  or  hinder  the 
controller  to  a  significant  degree.  An  example  is  the  case  with 
o=3. 6x,  K=7,  CD=tt,  an  exponential  commanded  trajectory,  and  initial 
condition  0i(O)=.O21.  Some  of  the  response  characteristics  are 
contained  in  Table  5. 

Table  5 


Initial  Condition  Effect  on  Response 


Category 

Response  without 
initial  conditions 

Response  with 
initial  conditions 

T  (max) 

5.2  Nm 

1.5  Nm 

T  (max) 

D 

2.1  Nm 

1.5  Nm 

2%  settling  time 

2  seconds 

1.5  seconds 

Largest  1  -  0^1 

.035  radians 

.115  radians 

Max  error  ( 02*  0*) 
2 


.023  radians 


.011  radians 


This  initial  condition  actually  helped  the  response  (for  the  most  part) 
in  this  case.  However,  the  I0i-0x!  stroke  constraint  was  violated 
when  the  initial  condition  was  added.  The  initial  condition  caused  an 
increase  in  the  maximum  10 1 -0x1  about  four  times  larger  than  the 
case  with  no  initial  condition.  The  solution  was  to  speed  up  the 
bottom  controller  (To)  to  CD=3rc,  reducing  the  maximum  10i-0Tl  to 
.024  radians  while  raising  the  required  Td  to  only  2  Nm.  However,  it 
was  made  evident  that  an  initial  condition  could  have  an 
unexpectedly  larger  effect  upon  the  performance. 

Parameter  sensitivity  was  given  only  a  cursory  examination. 

The  effect  on  the  response  was  observed  when  the  estimated  value 
for  I2  differed  from  the  actual  value  for  I2.  As  expected,  the 
response  was  not  as  good.  The  results  are  summarized  in  Table  6  for 
the  case  of  K=4,  a=3.67t,  zero  initial  conditions,  and  sinusoidal 
commanded  trajectory  for  02*  and  9x*. 

The  error  between  the  commanded  and  actual  trajectories 
increased  a  greater  percentage  than  the  error  in  the  parameter 
estimation,  so  the  controls  are  relatively  sensitive  to  parameter 
variations(at  least  for  I2).  The  parameter  I2  affects  the  slow  control 
mainly  as  a  gain.  Thus,  as  long  as  there  is  sufficient  gain  margin  in 
the  slow  control  design  the  control  is  stable.  However,  the  feed 
forward  terms  using  I2  cause  a  persistent  error  for  the  sinusoidal 
trajectory.  (The  correct  steady  state  value  is  achieved  for  the 
exponential  trajectory  due  to  the  integral  part  of  the  control). 

Various  other  parameters  may  have  greater  or  lesser  effects. 

For  example,  if  the  estimate  for  kj  varies  from  the  actual  value,  the 
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decoupling  control  terms  do  not  completely  decouple  the  systems, 
and  correction  might  be  required.  The  parameter  sensitivities  need 
to  be  explored  in  much  greater  depth. 


Table  .6 

Effect  of  Parameter  Estimation 
Error  upon  Performance 


Category 

^2act  ^2est 

^  2act  T2I2esl 

^2act~  -^2est 

T  (max) 

3  Nm 

3  Nm 

2.3  Nm 

T  (max) 

D 

3.25  Nm 

3.8  Nm 

3  Nm 

Error  "after"  transient 

0 

.012  (28%) 

.014  (33%) 

Next,  the  effect  of  sensor  noise  was  studied.  Gaussian  white 
noise  excitations  were  added  with  standard  deviations  of  1%  and  5% 
of  the  input  signal.  The  case  used  was  the  exponential  commanded 
trajectory  for  82*  and  87*,  o=3.6;c,  K=4,  and  initial  condition  8i(0)=.021. 
The  error  82-82*  is  shown  for  the  two  noise  levels  of  1%  and  5% 
respectively  in  figures  9  and  10.  It  is  evident  that  the  response  is 
fairly  good,  the  maximum  torque  magnitudes  are  still  about  the 
same,  and  the  181*87!  response  was  not  pronounceably  increased.  The 
performance  for  the  depicted  runs  is  summarized  in  Table  7. 
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Figure  9 


1%  Noise  Level 


Effect  of  Noise  upon  Performance 


Quantity 

No  Noise 

With  Noise 
(a  =  1%) 

With  Noise 
(  a  =  5%) 

T^  (max) 

2.1  Nm 

1.5  Nm 

1.8  Nm 

T  (max) 

D 

1.4  Nm 

1.5  Nm 

1.5  Nm 

Error  "after”  transient 

0 

.25  % 

.6% 

2%  "Settling"  Time 

1.5  sec 

1  sec 

1  sec 

1  9  {  '  9  Tl  max 

.11  rad 

.115  rad 

.12  rad 

Note:  The  variable  o  in  the  table  is  the  standard  deviation  of  the  noise 


4.3  Results  for  Scenario  B  Deformation  Shaping 

The  deformation  shaping  Scenario  B  performance  was  worse 
than  Scenario  A  in  most  respects.  Again,  this  was  due  to  the  slow 
control  design,  and  not  any  intrinsic  flaws  of  the  method.  The 
performance  is  summarized  in  Table  8. 


I 

I 
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Scenario  B  Deformation  Shaping 
Performance  Summary 


Category 

Low  BW 

High  BW 

T  'max) 

L 

11  Nm 

5  Nm 

^  ("after- 
transient) 

7  Nm 

3  Nm 

T  (max) 

35  Nm 

50  Nm 

T  ("after" 
transient) 

1.5  Nm 

1.5  Nm 

2%  settling  time 

15  sec 

6  sec 

These  results  were  with  a  sinusoidal  commanded  trajectory.  The  low 
bandwidth  control  used  w=3.1jt,  and  the  high  bandwidth  control  used 
w=7.75tc. 

For  Scenario  B,  increasing  the  dynamics  "speed"  did  not 
increase  the  torque  cost  nearly  as  much  as  in  Scenario  A.  The  control 
for  Td  actually  decreased  for  the  higher  BW  case.  However,  this  was 
because  the  control  Ti  for  the  lower  BW  case  could  not  keep  up  with 
the  commanded  trajectory  as  well  as  the  higher  BW  case,  and  needed 
more  help  from  Td. 
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V.  Comparison  of  Deformation  Shaping  with  Other  Methods 

5.1  Introduction  to  Comparisons 

Various  other  methods  of  control  design  were  used  to  obtain 
solutions  for  the  problem.  Most  of  these  solutions,  however,  used  all 
three  controllers  while  the  deformation  shaping  solutions  used  only 
two  controllers. 

Since  the  slow  control  design  for  Scenario  B  adversely  affected 
the  performance,  all  comparisons  will  be  made  with  the  deformation 
shaping  solution  of  Scenario  A. 

5.2  Deformation  Shaping  vs.  Rigidifying  Control 

The  rigidifying  control  is  detailed  in  Appendix  D.  It  was 
examined  with  the  same  fast  control  speed  constraints  as  the 
deformation  shaping  control.  The  rigidifying  control  low  BW  case 
had  w=3.6tc,  X=k  and  the  high  BW  case  had  w=10.8x,  X=3x.  The 
rigidifying  control  time  scale  separation  was  chosen  as  three  for  both 
cases.  This  is  compared  to  the  deformation  shaping  case  with  a  time 
scale  separation  of  three. 

The  maximum  torques  required  are  presented  in  Table  9  for 
the  case  with  no  initial  conditions  and  exponential  commanded 
trajectories. 
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Deformation  Shaping  vs.  Rigidifvin 


Performance  Comparison 


Category 

Deformation  Shaping 

Deformation  Suppression 

Low  BW 

High  BW 

Low  BW 

High  BW 

Td  (max) 

1.4  Nm 

9  Nm 

1.3  Nm 

3.3  Nm 

Tj  (max) 

2.1  Nm 

11.5  Nm 

18  Nm 

6.5  Nm 

T2  (max) 

0  Nm 

0  Nm 

.5  Nm 

1.5  Nm 

2%  settling 
time 

4  sec 

1.5  sec 

2.5  sec 

.5  sec 

The  required  torques  for  the  low  BW  are  very  similar,  and  the 
settling  time  isn't  even  twice  as  large.  The  higher  BW  controllers 
show  more  difference  in  required  torques  and  settling  times. 
However,  considering  that  the  deformation  shaping  is  using  only  two 
controls  while  the  rigidifying  is  using  all  three,  the  deformation 
shaping  is  doing  an  adequate  job  of  retaining  the  performance  of  the 
rigidifying  control.  The  responses  for  sinusoidal  commanded 
trajectories  also  display  this  trend. 


A  design  for  PID  control  was  made  so  that  the  error  dynamics 
would  be  no  faster  than  the  deformation  shaping  fast  dynamics.  The 
PID  control  using  all  three  actuators,  whose  design  is  detailed  in 
Appendix  E,  is  compared  to  the  deformation  shaping  control.  If  the 
top  actuator  failed  or  was  unavailable,  a  stable  PID  control  using  the 
bottom  two  actuators  could  not  be  found.  A  comparison  of  the 
controls  for  the  exponential  and  sinusoidal  commanded  trajectories  is 
made  in  Table  10. 

The  PID  control  outperformed  the  deformation  shaping  for  the 
exponential  commanded  trajectory  in  terms  of  response  time,  but  it 
did  not  do  as  well  for  the  sinusoidal  commanded  trajectory.  Even 
though  the  deformation  shaping  used  only  two  controls,  instead  of 
three,  it  was  able  to  beat  the  PID  control  in  this  case 


Table  IQ 


Deformation  Shaping  vs.  PTD 
Performance  Comparison 


Category 

Exponential 

Trajectory 

Sinusoidal 

Trajectory 

Deformation 

Shaping 

PID 

Deformation 

Shaping 

PID 

T  (max) 

2 

0 

3  Nm 

0 

4.6  Nm 

T  (max) 

5  Nm 

40  Nm 

3.25  Nm 

16  Nm 

T  (max) 

D 

3  Nm 

3  Nm 

3  Nm 

3  Nm 

2%  Settling 
Time 

2  sec 

.4  sec 

2  sec 

- 

-  ©2 

error  "after" 
transient 

0 

-0 

0 

.0025 

(3%) 
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Deformation  shaping  is  compared  with  a  "modern"  control  in 
the  form  of  an  LQR  design.  The  LQR  control  was  designed  to  have 
approximately  the  same  maximum  required  torque  magnitudes  as 
the  deformation  shaping,  so  the  responses  could  be  compared.  The 
LQR  design  is  detailed  in  Appendix  F. 

The  LQR  control  performance  was  comparabl  to  the 
deformation  shaping  control  performance. 

Table  11 

Deformation  Shaping  vs.  LOR 
Performance  Comparison 


Category 

Deformation 

Shaping 

LQR 

(max) 

5.2  Nm 

9  Nm 

T  (max) 

D 

2.1  Nm 

3.5  Nm 

2%  settling  time 

2  seconds 

1.6  seconds 

Table  11  compares  the  LQR  design  with  the  deformation  shaping  case 
with  a=3.6?c  and  K=7  for  the  exponential  commanded  trajectory.  The 
LQR  design  was  selected  to  have  comparable  control  torques,  and  the 
required  settling  time  was  then  found  comparable.  However, 
deformation  shaping  has  an  advantage,  although  it  didn't  apply  in 
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this  problem.  An  LQR  design  requires  full  state  feedback  (feedback 
of  all  dynamic  state  variables)  for  every  control  torque,  whereas 
deformation  shaping  does  not  require  this  in  general.  Only  the 
torques  with  a  fast  control  component,  such  as  Ti,  may  require  full 
state  feedback  (but  do  not  have  to).  The  other  torques  almost  always 
do  not. 

5.5  Summary  of  Comparisons  of  Results 

After  comparing  the  various  methods,  several  observations  can 
be  made.  In  general,  it  seems  that  deformation  shaping,  using  only 
two  controls  in  this  problem,  can  achieve  performance  about  equal  to 
that  by  PID  or  LQR  methods  using  all  three  controls.  The  price  paid 
for  this  capability  is  the  need  for  feed  forward  of  higher  derivatives 
of  the  commanded  trajectory.  A  summary  of  the  advantages  and 
disadvantages  of  the  various  control  solutions  is  presented  in  figure 
11. 
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VI.  Future  Work 

Many  unanswered  questions  remain  to  be  investigated.  One 
unknown  is  the  effect  of  disturbances  to  the  fast  dynamics  discussed 
in  3.5.  Also,  alternative  methods  of  introducing  the  fast  control  are 
possible,  such  as  introducing  the  fast  control  after  the  slow  control 
has  been  found.  Another  question  is  whether  deformation  shaping 
can  be  used  for  tracking  targets,  since  it  requires  higher  derivatives 
of  the  desired  trajectory.  A  technique  of  real  time  interpolation  of 
bearings  only  data  to  generate  higher  rates  used  in  robotics  is  found 
in  [Ref.  7]  ,  and  might  be  useful.  The  sensitivities  to  parameter 
variations  need  to  be  explored.  Finally,  various  schemes,  such  as 
treating  the  slow  manifold  as  a  sliding  surface  for  Variable  Structure 
Control,  might  be  added  and  tested  for  an  increase  in  the  robustness 
of  the  control,  albeit  at  the  cost  of  higher  required  bandwidth. 
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VII.  Conclusions 


The  deformation  shaping  method  was  able  to  solve  the  problem 
using  only  two  controllers  instead  of  all  three.  It  was  able  to  achieve 
exactly  the  correct  trajectory  for  the  ideal  case.  The  need  for  a  good 
slow  control  design  was  revealed  by  the  Scenario  B  results.  Initial 
conditions  affected  only  the  transient  response  levels,  while  the 
response  time  remained  the  same.  Parameter  estimation  error  was 
found  to  have  a  significant  impact  on  the  response  accuracy,  and 
should  be  investigated  further.  Sensor  noise,  on  the  other  hand,  had 
little  effect  on  the  accuracy. 

The  various  comparisons  with  the  other  methods  confirmed 
that  deformation  shaping  with  only  two  controllers  could  perform 
almost  as  well  as  the  other  methods  using  all  three  actuators.  The 
price  for  this  capability  was  the  need  for  higher  derivatives  of  the 
commanded  trajectory,  and  higher  complexity. 

The  various  advantages  of  deformation  shaping  make  it  a 
method  deserving  further  study. 


Actuator  Dynamics 

The  actuators  for  Tj  and  T2  are  standard  permanent  magnet  DC 
motors  and  can  be  found  to  have  the  following  transfer  function  [Ref. 
8]. 

KjRJs 

RJi:ms  +  Js  +KJKB  rA  n 


The  parameters  are  summarized  in  table  A.l 

Table  A.l 

Actuator  Parameter  Values 


Quantity 

Definition 

Value  for 

T, 

Value  for 

T2 

R 

Coil  Resistance 

8.76  Q 

2.3  n 

KX 

Force  Constant 

3  Ibf  /A 

.39  lb  ft/A 

Xm 

Electrical  Time  Constant 

4.56  ms 

6  ms 

J 

Inertia  or  Mass 

141  g 

.03  lb  in  sec2 

Back  EMF  Constant 

3.7  V/ft/sec 

.53  V/rad/sec 
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The  actuator  dynamics  for  To  are  not  as  simple.  The  dynamics 
are  the  result  of  a  complex  internal  hardware  controller.  From 
experimental  data,  an  approximate  transfer  function  was  found  for  it. 

20ns 

2  2 

s  +207TS  +  lOOtc  r a  n 


Compensation  was  performed  on  the  motors  for  two  reasons. 
First,  it  was  desired  to  have  a  steady  state  input  command  cause  a 
steady  state  torque  output  instead  of  a  steady  state  velocity  output. 
Secondly,  certain  BW  values  were  needed  for  the  actuators  in  order 
for  the  model  to  be  reasonable. 

Through  the  use  of  the  following  integral  feedback  scheme. 


with  Kn=ll,  Ki2=6,  Ai=12  and  A2=7  the  compensated  actuator 
dynamics  were  achieved.  It  was  also  assumed  that  it  was  possible  to 
compensate  the  Td  actuator  to  its  given  form  [I].  The  resulting 
actuator  BW  levels  were  1.5  Hz  for  Td,  30  Hz  for  Tj,  and  8.5  Hz  for  T2. 


Appendix  B 

Evaluation  of  Constants  Ci 

The  constants  co  to  cs  arise  when  the  controls  are  rewritten 
from  a  transfer  function  form  to  a  state  space  form.  In  general,  they 
are  the  result  of  synthetic  division  and/or  partial  fraction  expansions 
of  the  various  terms.  The  constants  used  in  scenario  a  will  be 
evaluated  first,  then  those  from  scenario  B. 

The  constants  cq  and  cj  come  directly  from  synthetic 
division  of  [47]. 


0 

0 

II 

3 

*—• 

1 

cr 

[B.l] 

Cj=  -  b(m j  -  b) 

[B.2] 

These  terms  show  up  in  many  of  the  following  expressions. 

The  terms  C2,  C3,  and  C4  arise  from  the  partial  fraction 
expansions  of  the  various  terms.  Intermediate  temporary 
expressions  tj,  t2,  and  t3  are  used  to  make  the  expressions  less 
cumbersome. 


t2-  aj(2a2  +  2cb)  - 

il  -2a!a2 
\b 

-  b(ti  -  a:(2a  +  b))j 

1 

2a  -  -b] 

b  J 

[B.3] 


c3=  ti  -  aj(2a  +  b)  -  c2  -  IiCj 


[B.4] 
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[3.5] 


C4= 


t3  -  2a,b c2  -  2t\a2 
b 


where 


ti  =  +  aoki 

[B.6] 

t2  =  a^o  +  m^ao  +  ki) 

[B.7] 

t3  =  mo(a0  +  ki) 

[B.8] 

The  new  constants  introduced  in  Scenario  B  were  C5,  C&,  c-j,  and 

Cg.  The  values  for  co  and  ci  were  as  above.  The  constant  for  C5  was 

merely  a  convenient  definition. 

c5  =  -20/60"  X 

[B.9] 

The  others  again  come  from  partial  fraction  expansion 

defined  using  intermediate  expressions  for  simplicity. 

and  are 

c6  =  (bt4  -  bts  +  t$) 

[B.10] 

c7  =  U  -  c6 

[B.11] 

c8  =  -bt4  +  ts  +  bc6 

[B.12] 
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where 


U  —  C0C5  + 

ts  =  moC5  - 

t6  =  -  lObX 


5!  -  10X* 

[B.13] 

lOX^mj  +  c5) 

[B.14] 

’(Co  +  cs) 

[B.15] 
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Appendix  C 

Program  Listing 

1  ee  PR06RAM  MA I N< TAPE  1  1  ,  TAPE! 2.  INPUT-TAPE  1 2  ,  OUTPUT) 

lie  EXTERNAL  DERIVS .ESPRK4  .INRKPC 

120  CALL  ESP  1 1 < DERI VS .ESPRK4  .INRKPC  ) 

1 30  ENO 

140  SUBROUTINE  CONTROL  (  TS4,TS3,TS2,TS1 .TS.Y.TCI  ,TC2,TD) 

150  REAL  TS4.TS3.TS2.TS1  .TS.TC1  .TC2.TO.SIG.LAtt.A1  .A0.K.K1  ,K2 

160  REAL  HI  .M0.B.II ,12. IT. CD 

170  REAL  Y< 1 00) 

180  LOGICAL  FLAG 

190  COMMON/THETATS/TTS ,TTS1  ,TTS2 

200  COMMON/PARAM/SIS.LAM.AI  .A0.K.K1 .K2.M1 .M0.B.I1 .12 , IT .CO .AAA ,BB8  ,CCC 

210  C0MM0N/FLA6S/FLA6 

220  C 

230  Y20  -  Y<  20 ) 

240  Y8  -  Y( 8  ) 

250  TC2  -  0.0 

260  TFAST  -  A! *Y<  6 )  ♦  A0»Y<5)  -  A1«Y(4)  -  A0*Y<3> 

270  TCI -TFAST+< 1 1 • I2/K2 )♦( T$4  +  2.0«SI6«TS3  +  2 .0»SI6«SI6*TS2  ) 

280  1  +  ( 1 1  • I2*K/K2  )•<  TS1  -  Y < S  >  +  (H1-B)«<TS  -  YC 5 ) )  +  Y8) 

290  2  +  K 1  •<  Y<  5 )  -  Y(  1  ) ) 

300  TO  -  ( IT«TTS2  +  2 .0* IT«CD*< TTS1 -Y( 2  ) )  ♦  IT*CD»CD*( TTS-Y( 1  ) ) )  - 

310  1  (  ( K* I2/K2  )«( A1 *( TS-Y( 5  ) >+Y20+Y( 18) )+< I2/K2  )•<  A1 *TS3+(  K 1 +A0 )* 

320  2  TS2  )+< -1 1 «I2«K/K2 )•( ( TS1 “Y<  6  ) )+( Ml -B  )*( TS-Y( 5 )  )+Y8  ) 

330  3  -  <  1 1 • I2/K2  >♦<  TS4+2 . *Sl6*TS3+2 .•SIG«SI6«TS2)  ) 

340  RETURN 

350  END 

360  SUBROUTINE  ICCOMP  (T.Y) 

370  DIMENSION  Y(  100). PARC  100) 

380  COMMON/ SUTCHS /SWT CMC  50 ) .SUMEttC  50 ,4  > .MAXSWS  .MAXMEtt  .NEVENT 

390  COMMON/PARS/PAR 

400  REAL  SI6.LAM.A1  .A0.K.K1  .K2.M1  .M0.B.I1  ,12, IT 

410  C0MM0N/PARAM/SI6 ,LAM ,A1  .A0.K.K1 ,K2 ,ttl .M0.8.I1 . 12 , IT ,C0 ,AAA  ,BBB  ,CCC 

420  COMMON/STPCON/HP ,H .FIXSTP ,HMIN .HttAX 

430  C 

440  FIXSTP  -  0.001 

450  LAM  •  3.1415927 

460  CD  -  3.1415927 

470  II  -  1.627 

480  12  -  0.863 

490  IT  -  0.417 

500  K 1-2.27 

510  K2  -  <9.8 

520  SIS  •  0.5»<7.2361 )»LAM 

530  A0  -  2.0*SI6»SI6«I I  -  K1  -  (11  +  12  )«K2/I2 

540  A I  -  2.0»SI6»I1 

550  K  -  4. »355. 92/49.8*K2/< 11*12 ) 
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560  Ml -SIS 

570  H0  -  SI6»SI6/4. 

580  S  -  SIS 

590  Cl  -  Al  «MI +A0+K  1 

600  C2  -  Al *M0+M1 «< A0+K1 ) 

510  C3  -  M0*(A0+K1 ) 

620  AAA  -  (  C2  -  A1»<2.*SIS*SIG+2.fSI6*8>  -  < C3/B-2 . «A1 •SIS»SI6  ) 

630  I  -B*< Cl -Al •< 2. *SI6+8 ) )  >/<  2. *SI6-2. •SIS«SIS/8-8  ) 

540  888  -  C!  -  Al  »(2. *SIG+8  >  -  AAA 

650  CCC  -  < C3-2. *AI •SIS«SI6«B-2. *SI6«SIS*AAA )/B 

660  Y(3)  -  0.021 

670  RETURN 

680  ENO 

690  SUBROUTINE  OERIUSI T  ,Y ,OY  .STOP > 

700  DIMENSION  Y(I00),  OY(I00),  PARM00) 

710  CQMMON/SUTCHS/SUTCH<  50  )  ,SUMEM<  50  ,4  )  .MAXSUS  .MAXMEM  .NEVENT 

720  COMMON/PARS/PAR 

730  REAL  SIG.LAM.AI  .A0.K.K1  .K2.M1  ,M0,B,I1  ,I2,IT 

740  REAL  K1 1  .KI2.K2I  .K22.KI1  ,KI2  ,AK ,AA ,KX  ,KA 

750  REAL  C0,TTS2,TTSI ,TTS 

760  L06ICAL  FLAG 

770  C0MMQN/PARAM/SI6  ,LAM  .  A 1  .A0.K.K1  ,K2,MI  .M0.B.U  .12  ,IT  ,CO  .AAA  ,BBB  ,CCC 

780  COMMON/TOOUT/TS.TSI .TS2 ,TS3 ,TS4 .TCI .TC2.TD 

790  COMMON/THETATS/TTS.TTSI .TTS2 

800  COMMON/ STPCON/HP ,H .FIXSTP ,HMIN ,HMAX 

810  C0MM0N/FLA6S/FLA6 

820  DATA  KK.KI1  ,K21 ,AK ,KI I /21 9.3 ,21 9.3 .271 37. 0  .20 . 1 27  ,B  .47/ 

830  DATA  KA  ,K'2  ,K22 ,AA ,KI2/ 1 66 .67 , 166 .67 ,5991 »4 ,7.0 ,6 .0/ 

840  OATA  FLA6/. FALSE./ 

850  DATA  PI/3. 1415927/ 

860  OATA  CONST ,TAU .TAUO/0.087 , .5, .5/ 

870  C 

880  TTS  -  CONSTM1.0  -  EXP( -T/TAUD  >  > 

890  TTS I  -  < CONST /TAUD )«EXP< -T/TAUD > 

900  TTS2  -  -<  CONST/( TAUO«TAUO  > )«£XP(  -T/TAUO ) 

910  TS  -  CONST*( 1 .0  -  EXP1-T/TAU) ) 

920  TS 1  -  ( CONST/TAU )*£XP< -T/TAU ) 

930  TS2  -  -( CONST/ ( TAU»TAU )  )• EXP < -T/TAU ) 

940  TS3  -  ( CONST/( TAU»*3.0 )  )• EXP ( -T/TAU ) 

950  TS4  -  -< CONST/( TAU«*4 .0 )  )«EXP( -T/TAU  > 
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969  C 
979  C 
989  C 
999  C 
1999 
1919  C 

1929 

1930  C 
1949 
10S0 
1069 
1970 
1080 
1990 
1100 
1110 
1120  C 
1130 
1140 
1150 
1160 
1170 
1180 
1190 
1290 
1210 
1220 
1230 
1240 
1250 
1260 
1270 
1280 
1290  C 
1300 

1319 

1320 
1330 
1340 
1 350 

1369 

1370 
1380 
1390 
>400 
1410 
1420 
1430 


TS  -  TS 1  -  TS2  -  0.0 
TS3  -  TS4  -  0.0 


CALL  CONTROL ( TS4,TS3,TS2,TS1  .TS.Y.TCI  .TC2.TO) 

ERROR  -  TS  -  Y<  5  > 

OY< 1  >  -  Y( 2  > 

OY<2>  -  < 1 . 0/ IT )*< TO  -  TCI  -  K 1 «Y( 1 )  +  K1«Y(3)> 

DY( 3  )  -  YU) 

DY( 4  )  -  ( 1 .0/11 >*< TCI  -  TC2  -  K2»< Y< 3 >-Y<5  ) )  -  K1 ♦< Y< 3  )-Y( 1  > )  > 
0Y<5)  -  Y< 6 ) 

DY( 6  >  -  < 1 .0/I2)*(TC2  -  K2«(Y(S)  -  Y<3))) 

OY<  7 )  •  -B«Y<7>  +  K*TS2  +  K«MI*TSl  +  K»M0»TS 
OY(  8 )  -  -8*Y(8>  ♦  ( M0  -  B*M1  +  B»8)»(ERRQR) 

•  ACTUATOR  INTEGRATORS  . 

DY(9)  •  Y( 1 0  > 

OY< 1 0  )  -  -K 1 1 «Y< 1 0  )  -  <K21  +  KI 1 *KK )*Y( 9)  +  AK*KK«KI 1 »TCl 
OY( 1 1  )  -  Y( 12) 

OY( 1 2  )  -  -K12»Y( 12  )  -  <K22  +  KI2«KA )*Y< 1 1 >  +  AA*KA*KI2*TC2 
DY<  13)  -  Y(  14) 

0 Y (14)  -  -20 . 0»PI»Y< 1 4 )  -  < 10.0«PI )**2.0*Y( 13)  ♦(  10.0*PI )«*2.0*TD 
OY(  IS)  -  Y<  16) 

DYUS)  -  -2.*SI6*YU6)-2.*SI6*SIS«YU5)+BB8*  TS1  +  CCC»TS 
OY< 17)  -  ( —8  ) * Y < 17)  +  AAA*TS 
OY (10)  -  YUS) 

0Y<)9>— 2. •SZ6*Y( 1 9  )-2 . •SI6*SI6*Y<  18 )+B8B»( TS I  — Y ( 6  > >+CCC»<  ERROR  ) 
DY( 20 )  •  -B«Y(20 )  +  (AAA  -  II»<M0  -  B«MI  +  B*B )  )«ERROR 
DY( 2 1  )  -  < -B )*Y<  21 )+(M0-B»(H1-B))*TS 
DY( 22  )  -  <-8)*Y<22  )+<M0-8*(Ml-B)  )*Y(5  ) 

OY(1S)-OYUS)»OYU7)-0. 

OY(  2 1 )-OY<22)-0. 

RETURN 

END 

SUBROUTINE  SUINPT ( VALUES ,T ,Y ) 

DIMENSION  VALUES<  50  ) ,  Y<1 00),  PARU00) 

COMMON/ SUTCHS/SWTCH< 50  > ,SWMEM<  50 ,4 ) .MAXSUS .MAXMEM  .NEVENT 

COMMON/PARS/PAR 

RETURN 

ENO 

SUBROUTINE  SUMEMN( VALUES ,  T,  Y) 

DIMENSION  VALUES<  50 ) ,  YU00),  PAR<  100  ) 

COMMON/SWTCHS/SWTCH<  50 ) ,SWMEM<  S0 ,4 ) .MAXSUS .MAXMEM  .NEVENT 

COMMON/PARS/PAR 

RETURN 

ENO 


I  440 

use 

use 

1470 
U80 
1490 
1 S00 
1510 
1520  C 
1530 
1540 
1550 
1560 
1570  C 
1580 
1590 
1600 
1610 
1620 
1630 
1640 
1650 
1660 
1670 
1680 
1690 
1700 
1710 
1720 
1730 
1740 
1750 
1760 
1770 
1780 
1790 


SUBROUTINE  OUTPUT < T ,Y ,DY .PLOT .PRINT .STOP  > 

01 HENS ION  Y( 100),  PARC  100),  PLOTC100).  PRINT ( 60  ) ,  OYCI00) 
COMMON/SWTCHS/SUTCHC  S0  > .SUMEMC  50 .4 ) .MAXSWS  .MAXMEM  .NEUENT 
COHNON/PARS/PAR 

REAL  TS  ,TS 1  ,TS2 ,TS3 ,TS4 ,TC1  ,TC2  ,TO 
COMMON/TOOUT/TS.TS1 ,TS2 ,TS3 ,TS4 ,TC1 .TC2.TD 
COMMON/THETATS/TTS.TTS1 .TTS2 
DATA  IAN/1/ 

IF < IAN  .Efl.  1  )THEN 
IAN  -  0 

CALL  ANALYZEC  T  ,Y  > 

ENOIF 


PRINT (  1  )-PLOT< 1  )-T 
PRINT <  2>-PLQT<2)-TS-YCS> 
PRINT C  3)-PL0T(3)-TSl 
PRINTC  4 )-PLOTC  4  >*TCJ 
PRINT (  S J-PLOTC SJ-TC2 
PRINTC  6)-PLOTC6)-TO 
PRINTC  7  J-PLOTC  7 )-Y< 1  ) 
PRINTC  8)-PLQT<8)-YC3> 
PRINTC  9)-PLOT(9)-YCS> 
PRINTC 10J-PLOTC 10J-YC9) 
PRINTC I l  1-PLOTC11  )*YC 1 1 > 
PRINTC 1 2 J-PLOTC 12 )-Y< 13) 
PRINTC 1 3  )-PLOT< 1 3 )-Y<  7  > 
PRINTC 14J-PL0TC I4J-YC8) 
PRINTC IS  3-PLOTC 1 5  >-YC 1 8 ) 
PRINTC 1 6  J-PLOTC 1 6  >-YC  20  > 
PRINTC 17J-PL0TC 17J-TS 
PRINTC 18 J-PLOTC 18)-TTS 
PRINTC 19 J-PLOTC 19 )-Y( 5 >-YC 3) 
PRINTC  20 )-PL0T <  20  )-Y<  3  )-Y( 1  > 
RETURN 
ENO 


i 
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Appendix  D 

Rigidifying  Control  Design 

The  rigidifying  or  deformation  suppression  case  is  just  a  special 
case  of  deformation  shaping.  It  makes  the  flexible  structure  behave 
as  a  rigid  body  after  the  fast  dynamics  die  out.  The  slow  manifold  in 
this  case  is  called  the  rigid  body  manifold.  Recall  the  equations 
resulting  from  the  singular  perturbation  expansions  [38]  to  [41], 

Using  these  equations,  slow  controls  can  be  designed  similar  to  what 
was  previously  done  for  the  deformation  shaping  case.  The  resulting 


torques  are: 


T2  =  I2{©  2  +2X(0  2  -  02)  +x  (6  2  -  e2)} 


Tl  =d!  +12)  [6  2  +2X(0  2  -  e2)  +x  (0  2  -  02)}  +k!(02  -  0X) 


Tl  =  Tl  +  ([w2I ,  -  (k1(Il  'fl^k 2)1(6;  -  6,)  +2wl1(0;-  8,)) 

1 2 


«  .  2  * 

To  =  It{0  t  +2p(0  t'0t)+M’(0t*  + 

m*  #  •  2  • 
(II  -H 1 2^(0  2  +2X(0  2  '  62)  (0  2" 


IP-1] 


[D.2] 


[C.3] 


[D-4] 


where  1A  is  the  time  constant  of  the  02*-02  error  dynamics,  1/ji  is 
the  time  constant  of  the  0t*-0t  error  dynamics,  and  1/w  is  the  time 
constant  of  the  critically  damped  fast  dynamics.  Unlike  the 
deformation  shaping  control,  the  time  scale  separation  between  X  and 
w  can  be  chosen. 
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Appendix  E 

PID  Control  Design 

The  PID  controller  for  T2  was  designed  to  make  the  angle  error 
from  the  desired  trajectory  go  to  zero.  The  bottom  two  controllers 
were  designed  to  make  the  angle  between  the  two  adjacent  bodies  go 
to  zero.  The  controllers  for  these  actuators  were  designed  to  treat 
the  bodies  above  them  as  a  single  rigid  body.  Thus,  the  Ti  controller 
treated  the  pointing  mirror  and  optical  bench  as  one  body  with 
inertia  I1+I2.  The  Td  controller  was  designed  treating  the  body  as 
entirely  rigid  with  inertia  It+Ii+12. 

The  resulting  parameter  gains  were: 


Kid=Kii=Ki2=500 

[E.1] 

Kpd=Kp1=Kp2=  1 00 

[E.2] 

Kdd=Kdi  =Kd:=5 

[E.3] 

Of  course,  a  better  design  is  possible,  but  this  one  worked  well  for 
the  given  problem. 

A  similar  design  using  only  Ti  and  Td  worked  adequately  for 
the  exponential  trajectory,  but  could  not  be  stabilized  for  the 
sinusoidal  trajectory.  The  best  that  could  be  achieved  with  the  PID 
control  would  be  marginally  stable. 


Appendix  F 

LQR  Control  Design 

The  LQR  design  was  done  with  the  following  costs. 

Cost  for  use  of  1000 

Cost  for  use  of  Ti  =  1 

Cost  for  use  of  Td  =  .01 

Cost  for  error  in  02  =  10 

Cost  for  error  in  0i  =  1 

Cost  for  error  in  ©x  =  5 

These  gave  reasonable  torque  levels  for  the  resulting  controls,  which 
were  of  the  form: 

T2  =  Ktdd(©T  -  ©t)  +  K2d(©T  *  ©t)  +  &2id(©  1  * 

+  K2i(©i  -  ©l)  +  K22d(©2  *  ©2)  +  K 22(0 2  -  ©2)  [E.l] 

Ti  =  Kidd(©t  ■  ©r) +  Kid(©t  -  ©x)  +  Khd(©  i  -  ©1) 

+  Kn(©i  -  ©1)  +  K]2d(©2  -  ©2)  +  Ki2(©2  -  ©2)  [E.2] 

Td  =  Kddd(©t  •  ©t)  +  KDd(qt  -  ©x)  +  Kdid(©  i  *  ©1) 

+  Kdi(@1  -  ©1)  +  Kd2d(©2  -  ©2)  +  Kd2(©2  -  ©2)  [E.3] 

The  values  used  for  ©i*  and  its  derivative  were  identical  to  those  of 
©2*  and  its  derivative.  The  values  for  ©x*  were  given  as  in  Scenario 
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A.  The  resulting  feedback  gains  were: 


For  T2: 

^2dd  -  6.5E-05 

K2D  =  3.9E-03 

K2id  =  3.8E-03 

K21  =  .14 

K22D  =  -03 

K22  =  .096 

For  Ti: 

Kjdd  =  -1-92 

Kid  =  -4.19 

Kud  =  31.7 

Kn  =  325 

K12D  =  35.8 

Ki2  =  -44.3 

For  Td: 

Kddd  =  8.43 

KDd  =  89.7 

Kdid  =  25.4 

D 
*— • 

II 

»— * 
00 
u> 

Kd2D  =  14.85 

KD2  =  -43.5 
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